✨

2022-10-10 14:40:54 +02:00
parent ac5e76d977
commit d4a4d1c443
1 changed files with 2 additions and 1 deletions
--- 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: