diff --git a/selflocalization/selflocalize.py b/selflocalization/selflocalize.py index 80a9dc1..c8707c4 100644 --- a/selflocalization/selflocalize.py +++ b/selflocalization/selflocalize.py @@ -254,7 +254,7 @@ try: particle.add_uncertainty(particles, SIGMA, SIGMA_THETA) est_pose = particle.estimate_pose(particles) # The estimate of the robots current pose calc_weight(est_pose, landmark_values) - est_weight = est_pose.weight + est_weight = est_pose.weight * 10**5 print("est_weight:", est_weight) if est_weight > 1: draw_world(est_pose, particles, world)