高斯牛顿法--slam 迭代求解相机位姿