Quaternion kinematics for the error-state Kalman filter 2021年01月19日 paper 字数:158 Notes on paper code blog