Update imu.c

Minor changes, cleanup