custom imu mvalink message plus some clean up