LINS: A Lidar-Inertial State Estimator for Robust and Efficient Navigation