Figure 5:
Control loop for waypoint navigation.
