Imu improvements
Write tests for IMU, pass them.
This MR has little to contribute to Master apart from IMU, but there are a few little impros.
Write tests for IMU, pass them.
This MR has little to contribute to Master apart from IMU, but there are a few little impros.