This IMU code is an Extended Kalman Fitler. It is currently using simulated input; the next step is taking input from a microcontroller & its sensors.