NikolajDanger/Roboteksperimentarium
1
0 Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

✨

Browse Source
This commit is contained in:
NikolajDanger committed 2022-10-10 14:40:54 +02:00
1 parent ac5e76d977
commit d4a4d1c443
1 file changed
+2 -1
Download Patch File Download Diff File Expand all files Collapse all files
selflocalization/selflocalize.py
+2 -1
View File
@@ -255,7 +255,8 @@ try:
est_pose, certainty = particle.estimate_pose(particles) # The estimate of the robots current pose est_pose, certainty = particle.estimate_pose(particles) # The estimate of the robots current pose
calc_weight(est_pose, landmark_values) calc_weight(est_pose, landmark_values)
est_weight = est_pose.weight * 10**23 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: if est_weight > 1 and certainty > 1:
break break
else: else: