Stereo-Vision-Aided Inertial Navigation