Paso 6: Gestión de punto de referencia
Para navegar en un curso, necesitamos una forma de administrar los diferentes waypoints. Empecé creando un WaypointClass simple que contiene un valor de longitud y latitud. Luego he creado una matriz de WaypointClass miembros para sostener los waypoints y una variable de currentWaypoint para mantener el punto de referencia actual.
Continuamente comprobamos la distancia hasta el waypoint actual; Si la distancia cae dentro de una tolerancia configurable (digamos 5 metros), decimos que se ha alcanzado el punto de referencia actual y avance hasta el siguiente waypoint de la matriz.
Un waypoint con 0 / 0 valores significa el final del programa.
