A Square Root Inverse Filter for Efficient Vision-aided Inertial Navigation on Mobile Devices
stochastic models , estimation and control .