企业官网建设流程全解析

我们来手把手推导左扰动模型的雅可比矩阵。我会把每一步的数学变换和背后的几何直觉讲清楚，并最终和ORB-SLAM3的代码严格对应。

我们定义旋转矩阵 R的作用是将世界坐标系下的点 p 变换到相机坐标系：

第六步：与 ORB-SLAM3 代码“实锤”对应

现在来看MLPnPsolver.cc中的高斯-牛顿迭代代码：

cpp

Vector3d p_cam = R * p_i; // 计算 R * p Matrix<double, 3, 6> J; J.block<3,3>(0,0) = -skew(R * p_i); // 左扰动雅可比：- [R * p]_× J.block<3,3>(0,3) = I; // 平移雅可比：I // 后面会把 J 左乘权重 W（即信息矩阵的平方根），构建正规方程 H += J.transpose() * W * J; b += J.transpose() * W * error;