Added Matt's IMU code.
Should be cross-version capatable.