From d4a4d1c443dd6a099a5126cdef44efdff62386d6 Mon Sep 17 00:00:00 2001 From: NikolajDanger Date: Mon, 10 Oct 2022 14:40:54 +0200 Subject: [PATCH] :sparkles: --- selflocalization/selflocalize.py | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) diff --git a/selflocalization/selflocalize.py b/selflocalization/selflocalize.py index fcc95d5..b70de03 100644 --- a/selflocalization/selflocalize.py +++ b/selflocalization/selflocalize.py @@ -255,7 +255,8 @@ try: est_pose, certainty = particle.estimate_pose(particles) # The estimate of the robots current pose calc_weight(est_pose, landmark_values) est_weight = est_pose.weight * 10**23 - print(est_weight) + print("est_weight:", est_weight) + print("certainty:", certainty) if est_weight > 1 and certainty > 1: break else: