Fix IMU test script.

IMU numbers look good.
Integrate in radians.