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

✨

Browse Source
This commit is contained in:
NikolajDanger
2022-10-10 14:47:19 +02:00
parent f60b56587a
commit f8de362c43
1 changed files with 2 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
selflocalization/selflocalize.py
View File

@ -258,6 +258,8 @@ try:
print("est_weight:", est_weight) print("est_weight:", est_weight)
print("certainty:", certainty) print("certainty:", certainty)
if est_weight > 1: if est_weight > 1:
draw_world(est_pose, particles, world)
cv2.imwrite("test.png", world)
break break
else: else:
arlo.go_diff(POWER, POWER, 0, 1) arlo.go_diff(POWER, POWER, 0, 1)