State Estimation, Planning and Control for Quadrotor
State Estimation of Quadrotor with IMU and Visual Odometry
The Green path is the estimated states by fusing IMU and visual odometry
through Augmented EKF.
The Red path is the ground truth.
The Blue quadrotor in Rviz shows the instant estimated states.