Manual control fixes

Manual control messages were not being processed unless the FCU was in HIL mode.
With these changes the manaul control messages are processed.