IMU Code Finished

I have successfully calibrated, fused, and created a visualizer for the IMU. Now's the easier part: setting up code for the rotors.

• Implemented Kalman filter
• Uses Gyroscope and Accelerometer to determine position
• Can accurately determine the Roll and Pitch of the quadrotor.