实验室三维重构的一个步骤:已知三维点坐标和对应点图像坐标,求摄像机矩阵P
算法描述在《计算机视觉中的多视图几何》P123
归一化后用DLT求初值。方法是将3*4的矩阵P改写为12*1矩阵(直接每行转置后竖着排列起来)。
x1 y1 z1是三维点的坐标,pt3是图像上对应点的坐标,K是已标定好的内参
function P3=newtonGetP3(x1,y1,z1,pt3,K)
XYZ=[x1';y1'
function P3=newtonGetP3(x1,y1,z1,pt3,K)
XYZ=[x1';y1'