Changed the distance calculation to stock

I've created a new function called getDistanceToWaypoint() to calculate
the current distance with the stock functionality
Show the estimate time to the distance

I've added a new method getTimeToDistance() to get the estimate time.
Revert "Changed the distance calculation to stock"

This reverts commit ec6313fd09bc901eb66578e22a5f1931708ba625.