diff --git a/leo/ruote.py b/leo/ruote.py index 79ffaa2..791e88a 100644 --- a/leo/ruote.py +++ b/leo/ruote.py @@ -7,20 +7,19 @@ mSinistra = Motor(Port.B) def vai_avanti(speed, gradi): + print(f"vado avanti di {gradi} a {speed}") mSinistra.run_angle(speed, gradi, then=Stop.NONE, wait=False) - mDestra.run_angle(-speed, gradi, then=Stop.NONE, wait=False) + mDestra.run_angle(-speed, gradi, then=Stop.NONE, wait=True) def turn(speed_L, speed_R, gradi): + print("girano le palle") mSinistra.run_angle(speed_L, gradi, then=Stop.NONE, wait=False) - mDestra.run_angle(speed_R, gradi, then=Stop.NONE, wait=False) + mDestra.run_angle(speed_R, gradi, then=Stop.NONE, wait=True) -print("test1") vai_avanti(1000, 360) -print("test2") turn(1000, 1000, 360) -print("test3") vai_avanti(1000, 360) turn(1000, 1000, 360)