Offboard2

Ready for code review. Guess this should be valid until the next mavlink revision is implemented.