Fix selected sg jumps to early by correcting the distances on route

[PaulPickhardt]

If available, link to the ticket

Bug reported by user. The selected traffic light jumps to the next traffic light when the user is close to the current traffic light. This was due to the missing distance added when the first waypoint was not on a route segment.

Closes: #

QA Checklist

Author

• [x] Code Review
• [x] Functionality Tested (iOS and Android + different screens)
• [ ] Light/Dark Mode Tested
• [ ] Performance/Energy Consumption Tested (especially in ride view)

Reviewer

• [x] Code Review
• [ ] Functionality Tested (iOS and Android + different screens)
• [ ] Light/Dark Mode Tested
• [ ] Performance/Energy Consumption Tested (especially in ride view)