✨

2022-10-10 14:28:11 +02:00
parent dc8f23bd5e
commit ac6d94ee39
1 changed files with 2 additions and 1 deletions
--- a/selflocalization/selflocalize.py
+++ b/selflocalization/selflocalize.py
@ -253,7 +253,8 @@ try:

        particle.add_uncertainty(particles, SIGMA, SIGMA_THETA)
        est_pose = particle.estimate_pose(particles) # The estimate of the robots current pose
-        print(calc_weight(est_pose, landmark_values))
+        calc_weight(est_pose, landmark_values)
+        print("est_pose weight: ", est_pose.weight)

        if showGUI:
            # Draw map