Switched Nav code to native UAVX. Corrections to turn to WP. Commissioned physics based emulation mode.