testes para garantir que esta tudo nice
Refactor da forma como são encontrados os waypoints, posicao final e inicial