[fix] Yaw command was overwritten by trim.
[rotorcraft] Added serveral modes to make flying without RC possible.