Calculo de la Trayectoria

Calculo de la Trayectoria:
Parte 1º
En este ejercicio, lo que se nos pedía es que mediante la introducción de unas coordenadas al robot y un ángulo de orientación final, el robot pudiera
dirigirse a ese punto satisfactoriamente.
Los pasos que hemos seguido han sido los siguiente.
1- Creación de un menú donde introducimos las coordenadas X e Y y el ángulo de destino
2- Orientación del robot hacia ese destino
3- Movimiento del robot hacia las coordenadas indicadas
4- Orientación final del robot, al ángulo previamente introducido.
Con estos pasos hemos conseguido que el robot llegue al punto deseado quedándose en el estado indicado.

Con este vídeo ilustrativo podemos observar el resultado de lo dicho: