diff --git a/selflocalization/selflocalize.py b/selflocalization/selflocalize.py index 397dede..72db8a8 100644 --- 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