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, although there is still a frequent loss and regain of manual control signal, possibly due to latency in processing messages vs. simply receiving the RC input values.