Offboard2: Handle external setpoint messages

**Work in progress**
This PR tracks the progress of the integration of the new external setpoint messages.
Essentially this is #1116 but now against master.