842107.fig.0012
Figure 12: Control loop for waypoint navigation using the EKF for heading estimation.