diff --git a/selflocalization/selflocalize.py b/selflocalization/selflocalize.py index fcc95d5..b70de03 100644 --- 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: