Adaptive filtering for vision-aided inertial navigation