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 assi import A
|
||||
from leo import giro
|
||||
|
||||
# from leo import giro
|
||||
from robot_class import LazyRobot, Robot
|
||||
from robots import leorobot as robot
|
||||
|
||||
|
|
@ -44,10 +45,9 @@ def main(robot: LazyRobot):
|
|||
while (destinazione - gradi_attuali) > 0.2 or (
|
||||
destinazione - gradi_attuali
|
||||
) < -0.2:
|
||||
gradi_mancanti = gradi_attuali - destinazione
|
||||
gradi_mancanti = destinazione - gradi_attuali
|
||||
velocita = abs(gradi_mancanti)
|
||||
print("Gradi manc: ", gradi_mancanti)
|
||||
if curva_normale:
|
||||
if gradi_mancanti > 0:
|
||||
robot.left.run(velocita + aumento_v)
|
||||
robot.right.run(-velocita - aumento_v)
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue