Tied the in the nav mode by overriding the dynamics model functions
called by autopilot and calling the Dyn4DofModel specific fly
functions.
Working on loiter now, Autopilot has to actually dynamically
cast the autopilot because of the uniqueness of Dyn4DofModel in
comparison with other models.