From ac6d94ee39f07a22f129a6e7358f5595ac90fb1f Mon Sep 17 00:00:00 2001 From: NikolajDanger Date: Mon, 10 Oct 2022 14:28:11 +0200 Subject: [PATCH] :sparkles: --- selflocalization/selflocalize.py | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) 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