Added PID control and direct control support for ldtvo. Added the extended navigation model with roll, pitch, altitude.
Merge.