Intento de arreglar los waypoints

Cambiado algo del código y otro stuff