Stap 6: Waypoint Management
Om te navigeren van een cursus, moeten we een manier voor het beheren van de verschillende waypoints. Ik begon met het ontwerpen van een eenvoudige WaypointClass die in het bezit van een waarde voor lengte- en breedtegraad. Ik heb vervolgens een matrix van WaypointClass leden te houden van de waypoints, en een currentWaypoint-variabele voor het bijhouden van het huidige waypoint.
We controleren voortdurend de afstand tot het huidige waypoint; Als de afstand valt binnen een configureerbare tolerantie (zeggen 5 meter), wij zeggen dat het huidige waypoint is bereikt en doorgaan naar het volgende waypoint in de matrix.
Een waypoint met 0 / 0 waarden betekent het einde van het programma.