Navigating issues

[Starcommander]

Sometimes there are issues while navigating.
If you do not execute the next nav-point and drive a little bit around it, then obviously the path is not more updating anymore.
Sometimes the path is not recalculating although you leave the path with a long distance.
And sometimes the navigation does not update distance, and stucks in initial state. (searching for location)

Therefore I plan a debug-mode, where additional info is shown.

• How far is the current location away from path, when does it recalculate. [counter]
• Is it updating [counter]
• Way distance as on top label.
• Switch for debug-nav-simulator
• Current speed
• Got location [counter]
• Additional error logs