This commit is contained in:
NikolajDanger
2022-09-28 13:44:52 +02:00
parent 0c3b5a7684
commit a675ecfc88

View File

@ -43,7 +43,9 @@ def find_arucos(arlo):
arucos = find_aruco(arlo.take_photo()) arucos = find_aruco(arlo.take_photo())
if arucos != []: if arucos != []:
for aruco, id_ in arucos: for aruco, id_ in arucos:
aruco_dict[id_] = aruco if id_ in [1,6]:
print(f"found box {id_}")
aruco_dict[id_] = aruco
if len(aruco_dict) >= 2: if len(aruco_dict) >= 2:
break break
@ -51,7 +53,7 @@ def find_arucos(arlo):
sleep(0.3) sleep(0.3)
arlo.stop() arlo.stop()
return list(aruco_dict.items())[:2] return list(aruco_dict.values())[:2]
def main(): def main():
arlo = Robot() arlo = Robot()