842107.fig.005
Figure 5: Control loop for waypoint navigation.