Request navigator state change also when receiving set mode commands

Together with #897 makes the QGC buttons work in HIL.