Extended Kalman Filter state covariance PositionNorth PositionEast PositionDown VelocityNorth VelocityEast VelocityDown AttitudeQ1 AttitudeQ2 AttitudeQ3 AttitudeQ4 GyroDriftX GyroDriftY GyroDriftZ