navigator: move set_previous_pos_sp to MissionBlock class
commander: modes fallback and reject messages fixed
navigator: RTL return altitude fixed