def executar_planejamento(planejamento):
robot_control = RobotControl()
while planejamento and robot_control.simulator.isConnected():
acao = planejamento.pop(0)
if acao == 'straight':
print("Seguindo em frente...")
elif acao == 'left':
print("Virando para a esquerda...")
elif acao == 'right':
print("Virando para a direita...")
robot_control.run(acao)
time.sleep(1)
print("Planejamento executado")
print()
robot_control.simulator.close()
commands = {
'8': 'straight',
'4': 'left',
'6': 'right',
}
while robot_control.simulator.isConnected():
print('''
Comandos:
Frente: 8
Esquerda: 4
Direita: 6
''')
command = input()
if command not in commands:
print('Comando Invalido')
continue
robot_control.run(commands[command])
command = 0
while robot_control.isWalking():
continue
print('Stopped')
print(command)
robot_control.simulator.close()
