A sensor fusion and filtering algorithm, taking in measurements from IMU, GPS, and Barometer to accurately estimate Altitude and Orientation