AC_WPNav: use atan2f, make methods const
Mission: make get_prev_nav_cmd_index const