curva precisa funzionante
This commit is contained in:
parent
6b2ccf19ec
commit
4da6485788
1 changed files with 12 additions and 12 deletions
|
|
@ -5,7 +5,8 @@ from pybricks.robotics import DriveBase
|
||||||
from pybricks.tools import wait
|
from pybricks.tools import wait
|
||||||
|
|
||||||
from assi import A
|
from assi import A
|
||||||
from leo import giro
|
|
||||||
|
# from leo import giro
|
||||||
from robot_class import LazyRobot, Robot
|
from robot_class import LazyRobot, Robot
|
||||||
from robots import leorobot as robot
|
from robots import leorobot as robot
|
||||||
|
|
||||||
|
|
@ -44,10 +45,9 @@ def main(robot: LazyRobot):
|
||||||
while (destinazione - gradi_attuali) > 0.2 or (
|
while (destinazione - gradi_attuali) > 0.2 or (
|
||||||
destinazione - gradi_attuali
|
destinazione - gradi_attuali
|
||||||
) < -0.2:
|
) < -0.2:
|
||||||
gradi_mancanti = gradi_attuali - destinazione
|
gradi_mancanti = destinazione - gradi_attuali
|
||||||
velocita = abs(gradi_mancanti)
|
velocita = abs(gradi_mancanti)
|
||||||
print("Gradi manc: ", gradi_mancanti)
|
print("Gradi manc: ", gradi_mancanti)
|
||||||
if curva_normale:
|
|
||||||
if gradi_mancanti > 0:
|
if gradi_mancanti > 0:
|
||||||
robot.left.run(velocita + aumento_v)
|
robot.left.run(velocita + aumento_v)
|
||||||
robot.right.run(-velocita - aumento_v)
|
robot.right.run(-velocita - aumento_v)
|
||||||
|
|
|
||||||
Loading…
Add table
Reference in a new issue