Update imu.c

Compile with -lm -O3 with mips-gcc