Closed carlibiri closed 4 years ago
Listo. He implementado una interpolación cúbica de la trayectoria de la base del rover cuando hay un salto grande en la asignación de waypoints del efector final. De este modo, genero varios waypoints a los que asigno configuraciones intermedias del manipulador, con lo que la trayectoria del brazo es más suave y está más controlada.
Falta seguir testeandolo para ver fallos, y arreglar un pequeño salto que aparece de vez en cuando en las variables articulares cuando el yaw de la trayectoria cambia bruscamente.
Terminado. Ahora se le aplica un filtro gaussiano al yaw del rover durante la trayectoria para que no se produzcan cambios bruscos. Como ahora el yaw es muy suave, también lo son las transiciones de las posiciones articulares del manipulador durante la trayectoria.
Dejo aqui una grafica donde se muestra la evolución de las posiciones articulares en uno de los test:
La trayectoria correspondiente:
Un saludo
Suavizado para evitar que el manipulador de saltos.