def moverse_giro_recta(robot, objetivo):
"""
Acción de moverse del robot hacia unas coordenadas objetivo.
"""
instruccion_giro1, instruccion_distancia, instruccion_giro2 = instrucciones_giro_avanzo_giro(
robot.pos[0], robot.pos[1], objetivo.pos[0], objetivo.pos[1],
robot.orientacion, objetivo.orientacion)
envio_instrucciones_traccion(instruccion_giro1, instruccion_distancia,
"0G+000")
def moverse_giro_recta_giro(robot, objetivo):
"""
Acción de moverse del robot hacia unas coordenadas objetivo y que acabe con un un ángulo final
"""
instruccion_giro1, instruccion_distancia, instruccion_giro2 = instrucciones_giro_avanzo_giro(
robot.pos[0], robot.pos[1], objetivo.pos[0], objetivo.pos[1],
robot.orientacion, objetivo.orientacion)
envio_instrucciones_traccion(instruccion_giro1, instruccion_distancia,
instruccion_giro2)
def golpear_manga(Parjitas,manga):
"""
Saca el brazo y tira la manga
"""
print("Saco el brazo")
#envio_instrucciones_actuadores()
print("No hace nada de momento")
Parejitas.actuador_manga = True
manga.disponible = False
envio_instrucciones_traccion(0,100,0)
print(("Recojo el brazo"))
from Eurocomunicacion_raspy_funciones import envio_instrucciones_traccion
envio_instrucciones_traccion("0D+050005000000", "0G-010", "0D-050005000000")