Observability analysis of navigation system using point-based visual and inertial sensors

A matrix Kalman filter (MKF) has been implemented for a navigation system using point-based visual and inertial sensors. The observability conditions have been proved by the observability rank criterion based on Lie derivatives. The conditions are: (a) at least one degree of rotational freedom is excited and (b) at least three observed points are not collinear where any two points are linearly independent. Experimental results have demonstrated that the proposed algorithm obtains the same accurate as the line-based algorithm.