curva precisa funzionante

This commit is contained in:
leo 2025-10-26 18:38:42 +01:00
parent 6b2ccf19ec
commit 4da6485788

View file

@ -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)