Added mixing code, not complete, not compiliing
UAVCAN: Fixed all compile errors
UAVCAN: improve printing, ready for full closed loop test
UAVCAN: Fix start / stop commands