基于视觉的ConstraintKalmanFilter算法介绍,AMulti-StateConstraintKalmanFilterforVision-aidedInertialNavigation