navigator: check if mission reached on vehicle_status updates
Merge branch 'mpc_local_pos' into mpc_rc
navigator: merging bug fixed