张正友标定法:“A Flexible New Technique for Camera Calibration”ESKF中的四元数运动学:”Quternion kinematics for the error-statE Kalman filter”