Minor changes in imu_msg implementation