UAVCAN update
Magnetometer self test