Math with IMU

Someone should write it