IMU code is taking shape