Alec added 1st draft of IMU filter code.