Copter: move init of global nav variables to set_nav_mode