Robust Vision-Aided Inertial Navigation Algorithm via Entropy-Like Relative Pose Estimation