✨

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: