worked on the imu test code