Ae galera, acho que está quase pronto, vou fazer mais uns testes depois para me certificar de que está pronto, tenho um problema de arredondamento também, a distância entre 0 ela pede como 6274.0, o meu deu 6273.9899
Enfim, amanhã vou melhorar a saída também e outar da maneira que ela deseja (Desse jeito que eu coloquei não ficou muito claro odesenho do caminho)