Using GTSAM, Velocity Estimator, and Extended Kalman Filter, the state of the quadrotor is estimated - View it on GitHub