本发明提出了一种基于定焦数码相机的旋转全景摄影测量方法和装置，当难以在被测物体上或周围布设控制点，但可以在其它位置或被测物对面布设控制点的情况下，利用少量控制点，可解算被测点的物方坐标，是解决现实场景中相机视场角小、控制点稀少难题的技术方案，是在困难场景进行近景摄影测量的一种有效的手段；本发明设备简单、成本较低，能够解决实际工作中控制点稀少时的摄影测量问题。
1.一种基于定焦数码相机的旋转全景相机的摄影测量方法，其特征在于，包括以下步骤：步骤1：在全景三维控制场中选择M个摄站，在每一摄站用定焦数码相机拍摄含控制点的影像，共M张影像；
步骤2：计算定焦数码相机的内方位元素(f,x0,y0)、畸变参数(K1,K2,P1,P2)；
提取M张影像上控制点的像点坐标(x,y)，利用已知的控制点像点坐标(x,y)、控制点在全景三维控制场的物方空间坐标(X,Y,Z)和共线方程式，见公式(1)，采用最小二乘的平差方法，解求定焦数码相机的内方位元素(f,x0,y0)、外方位元素(Xs,Ys,Zs,a1,a2,a3,b1,b2,b3,c1,c2,c3)、畸变参数(K1,K2,P1,P2)，f,x0,y0和K1,K2,P1,P2的结果作为真值参与后续计算；
式中，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，
式中，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r为M张影像上控制点的像点到像主点的距离，r＝(x-x0)2+(y-y0)2，f为定焦数码相机的焦距，Xs,Ys,Zs为投影中心S在全景三维控制场物方空间坐标系(G-X,Y,Z)中的坐标，a1,a2,a3,b1,b2,b3,c1,c2,c3为从像空间坐标系到全景三维控制场物方空间坐标系的旋转矩阵 中的元素；
步骤3：在全景三维控制场中选择N个摄站，在每一摄站上用旋转全景相机拍摄360°水平角的全景影像，共N张全景影像；
步骤4：计算旋转全景相机的旋转参数(US,VS,WS)和RS；
提取N张全景影像上控制点的像点坐标(x1,y1)；根据步骤2中的(f,x0,y0)、(K1,K2,P1,P2)、全景三维控制场中控制点的像点坐标(x1,y1)、全景三维控制场中控制点的物方空间坐标(X,Y,Z)和公式(2)，采用最小二乘的平差方法解求旋转中心在全景三维控制场物方空间坐标系中的坐标(XO,YO,ZO)、旋转坐标系在全景三维控制场物方空间坐标系中的初始角度α0和旋转全景相机的旋转参数；旋转全景相机的旋转参数包括定焦数码相机投影中心与旋转中心的偏移量(US,VS,WS)和相对姿态RS；
式中，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，
式中，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r1为N张影像上控制点的像点到像主点的距离，r1＝(x1-x0)2+(y1-y0)2，f为定焦数码相机的焦距，X′,Y′,Z′为全景三维控制场内控制点的物方空间坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a1′,a2′,a3′,b1′,b2′,b3′,c1′,c2′,c3′为从像空间坐标系到旋转坐标系的旋转矩阵中的元素，(XO,YO,ZO)为旋转坐标系与全景三维控制场物方空间坐标系的相对位置，α0为旋转坐标系在全景三维控制场物方空间坐标系中的初始角度；
步骤5：在测量现场布设3个以上的控制点Q1,Q2,Q3……；
步骤6：在测量现场选择T个摄站，在每一摄站上拍摄含Q1,Q2,Q3……和待测点的测量现场的全景影像，共T张全景影像；
步骤7：计算测量现场中旋转全景相机的旋转中心在测量现场物方空间坐标系中的坐标(X′O,Y′O,Z′O)和旋转坐标系在测量现场物方空间坐标系中的初始角度α′0；
提取测量现场的T张全景影像中控制点Q1,Q2,Q3……的像点坐标(x2,y2)；根据步骤2中的(f,x0,y0)、(K1,K2,P1,P2)、步骤4计算得到的全景相机的旋转参数US,VS,WS、RS、控制点Q1,Q2,Q3……的像点坐标(x2,y2)、控制点在测量现场物方空间坐标系中的坐标(XQ,YQ,ZQ)和公式(3)，采用最小二乘的平差方法解求旋转全景相机在测量现场的旋转中心坐标(X′O,Y′O,Z′O)、旋转坐标系在测量现场物方空间坐标系中的初始角度α′0；
式中，(x2,y2)为像点坐标，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，K1,K2为径向畸变参数，P1,P2
为偏心畸变参数，r2为T张全景影像中控制点Q1,Q2,Q3,……的像点到像主点的距离r2＝(x2-x0)2+(y2-y0)2，f为定焦数码相机的焦距，XP,YP,ZP为测量现场内控制点的物方空间坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2,a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵 中的元素，(X′O,Y′O,Z′O)为旋转坐标系与测量现场物方空间坐标系的相对位置，α′0为旋转坐标系在测量现场物方空间坐标系的初始角度；
步骤8：由α′0和旋转角度β＝(360/C)°，根据公式(4)计算每张像片的旋转角度α；
α＝α′0+(i-1)β (i＝1,2,…,C) (4)
步骤9：计算待测点在测量现场物方空间坐标系中的坐标(XA,YA,ZA)；
提取测量现场的T张全景影像上待测点的像点坐标(x3,y3)；利用已知的f,x0,y0、K1,K2,P1,P2、(US,VS,WS)、RS、(x3,y3)、(X′O,Y′O,Z′O)、α和公式(5)，采用最小二乘的平差方法解求待测点在测量现场物方空间坐标系中的坐标(XA,YA,ZA)；
式中，(x3,y3)为像点坐标，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，K1,K2为径向畸变参数，P1,P2
为偏心畸变参数，r3为T张全景影像上待测点的像点到像主点的距离，r3＝(x3-x0)2+(y3-y02
) ，f为定焦数码相机的焦距，XA,YA,ZA为待测点在测量现场物方空间坐标系中的坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2,a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵 中的元素，(X′O,Y′O,Z′O)为旋转坐标系与测量现场物方空间坐标系的相对位置，α′0为旋转坐标系在测量现场物方空间坐标系的初始角度；
2.一种使用如权利要求1所述的基于定焦数码相机的旋转全景相机的摄影测量方法的装置，其特征在于：包括一个旋转云台、一个机械固定支架、一台定焦数码相机；将定焦数码相机安装在机械固定支架上，所述的机械固定支架安装在旋转云台上。
3.根据权利要求2所述的基于定焦数码相机的旋转全景相机的摄影测量方法的装置，其特征在于：所述的旋转云台附有角度控制台。
4.根据权利要求1所述的一种基于定焦数码相机的旋转全景相机的摄影测量方法，其特征在于：所述的步骤3中拍摄全景影像的方法为每次旋转定焦数码相机相同的水平角度β＝(360/C)°拍摄影像，C为转动定焦数码相机的次数，直至覆盖360°水平角，共N张全景影像。
5.根据权利要求1所述的一种基于定焦数码相机的旋转全景相机的摄影测量方法，其特征在于：所述的步骤6中拍摄全景影像的方法为每次旋转定焦数码相机相同的水平角度β＝(360/C)°拍摄影像，C为转动定焦数码相机的次数，直至覆盖360°水平角，共T张全景影像，其中，T﹥0。
一种基于定焦数码相机的旋转全景摄影测量方法和装置
技术领域
[0001] 本发明属于近景摄影测量领域，特别涉及一种基于定焦数码相机的旋转全景摄影测量方法和装置。
背景技术
[0002] 在近景摄影测量中，普通数码相机的视场较小，拍摄时需要有大重叠度的多张影像来覆盖被测物体，另一方面，在测量现场进行近景摄影测量的外业工作时，遇到不能在被测物上或周围布设足够数量控制点的情况，采用常规近景摄影测量方法不能满足区域网平差要求，这在很大程度上限制了普通数码相机的近景摄影测量应用范围。因此有必要针对普通数码相机视场角小和所需控制点数量多、控制点分布受限制的难题，研究一种新的近景摄影测量解决方案。
发明内容
[0003] 针对背景技术存在的问题，本发明提出了：一种基于定焦数码相机的旋转全景摄影测量方法和装置，设备简单、成本较低，能够解决实际工作中控制点稀少时的摄影测量问题。
[0004] 本发明提供一种解决上述技术问题的技术方案如下：
[0005] 一种基于定焦数码相机的旋转全景摄影测量装置，包括一个高精度旋转云台、一个机械固定支架、一台定焦数码相机；将定焦数码相机安装在机械固定支架上，所述的机械固定支架安装在旋转云台上。
[0006] 优选的，所述的旋转云台附有角度控制台。
[0007] 一种基于定焦数码相机的旋转全景相机的摄影测量方法，包括以下步骤：
[0008] 步骤1：在全景三维控制场中选择M个摄站，在每一摄站用定焦数码相机拍摄含控制点的影像，共M张影像；
[0009] 步骤2：计算定焦数码相机的内方位元素(f,x0,y0)、畸变参数(K1,K2,P1,P2)；
[0010] 提取M张影像上控制点的像点坐标(x,y)，利用已知的控制点像点坐标(x,y)、控制点在全景三维控制场的物方空间坐标(X,Y,Z)和共线方程式，见公式(1)，采用最小二乘的平差方法，解求定焦数码相机的内方位元素(f,x0,y0)、外方位元素(Xs,Ys,Zs,a1,a2,a3,b1,b2,b3,c1,c2,c3)、畸变参数(K1,K2,P1,P2)，f,x0,y0和K1,K2,P1,P2的结果作为真值参与后续计算；
[0011] 公式(1)如下所示：
[0012]
[0013] 式中，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，
[0014]
[0015] 式中，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r为M张影像上控制点的像点到像主点的距离，r＝(x-x0)2+(y-y0)2，f为定焦数码相机的焦距，Xs,Ys,Zs为投影中心S在全景三维控制场物方空间坐标系(G-X,Y,Z)中的坐标，a1,a2,a3,b1,b2,b3,c1,c2,c3为从像空间坐标系到全景三维控制场物方空间坐标系的旋转矩阵 中的元素；
[0016] 步骤3：在全景三维控制场中选择N个摄站，在每一摄站上用旋转全景相机拍摄360°水平角的全景影像，共N张全景影像；
[0017] 步骤4：计算旋转全景相机的旋转参数(US,VS,WS)和RS；
[0018] 提取N张全景影像上控制点的像点坐标(x1,y1)；根据步骤2中的(f,x0,y0)、(K1,K2,P1,P2)、全景三维控制场中控制点的像点坐标(x1,y1)、全景三维控制场中控制点的物方空间坐标(X,Y,Z)和公式(2)，采用最小二乘的平差方法解求旋转中心在全景三维控制场物方空间坐标系中的坐标(XO,YO,ZO)、旋转坐标系在全景三维控制场物方空间坐标系中的初始角度α0和旋转全景相机的旋转参数；旋转全景相机的旋转参数包括定焦数码相机投影中心与旋转中心的偏移量(US,VS,WS)和相对姿态RS；
[0019] 公式(2)如下所示：
[0020]
[0021] 式中，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，
[0022]
[0023] 式中，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r1为N张影像上控制点的像点到像主点的距离，r1＝(x1-x0)2+(y1-y0)2，f为定焦数码相机的焦距，X′,Y′,Z′为全景三维控制场内控制点的物方空间坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2,a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵中的元素，(XO,YO,ZO)为旋转坐标系与全景三维控制场物方空间坐标系的相对位置，α0为旋转坐标系在全景三维控制场物方空间坐标系中的初始角度；
[0024] 步骤5：在测量现场布设3个以上的控制点Q1,Q2,Q3……；
[0025] 步骤6：在测量现场选择T个摄站，在每一摄站上拍摄含Q1,Q2,Q3……和待测点的测量现场的全景影像，共T张全景影像；
[0026] 步骤7：计算测量现场中旋转全景相机的旋转中心在测量现场物方空间坐标系中的坐标(X′O,Y′O,Z′O)和旋转坐标系在测量现场物方空间坐标系中的初始角度α′0；
[0027] 提取测量现场的T张全景影像中控制点Q1,Q2,Q3……的像点坐标(x2,y2)；根据步骤2中的(f,x0,y0)、(K1,K2,P1,P2)、步骤4计算得到的景相机的旋转参数US,VS,WS、RS、控制点Q1,Q2,Q3……的像点坐标(x2,y2)、控制点在测量现场物方空间坐标系中的坐标(XQ,YQ,ZQ)和公式(3)，采用最小二乘的平差方法解求旋转全景相机在测量现场的旋转中心坐标(X′O,Y′O,Z′O)、旋转坐标系在测量现场物方空间坐标系中的初始角度α′0；
[0028] 公式(3)如下所示：
[0029]
[0030] 式中，(x2,y2)为像点坐标，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r2为T张全景影像中控制点Q1,Q2,Q3,……的像点到像主点的距离r2＝(x2-x0)2+(y2-y0)2，f为定焦数码相机的焦距，XP,YP,ZP为测量现场内控制点的物方空间坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2，a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵 中的元素，(X′O,Y′O,
Z′O)为旋转坐标系与测量现场物方空间坐标系的相对位置，α′0为旋转坐标系在测量现场物方空间坐标系的初始角度；
[0031] 步骤8：由α′0和旋转角度β＝(360/C)°，根据公式(4)计算每张像片的旋转角度α；
[0032] 公式(4)如下所示：
[0033] α＝α′0+(i-1)β(i＝1,2,…,C) (4)
[0034] 其中，C为转动定焦数码相机的次数；
[0035] 步骤9：计算待测点在测量现场物方空间坐标系中的坐标(XA,YA,ZA)；
[0036] 提取测量现场的T张全景影像上待测点的像点坐标(x3,y3)；利用已知的f,x0,y0、K1,K2,P1,P2、(US,VS,WS)、RS、(x3,y3)、(X′O,Y′O,Z′O)、α和公式(5)，采用最小二乘的平差方法解求待测点在测量现场物方空间坐标系中的坐标(XA,YA,ZA)。
[0037] 公式(5)如下所示：
[0038]
[0039] 式中，(x3,y3)为像点坐标，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r3为T张全景影像上待测点的像点到像主点的距离，r3＝(x3-x0)2+(y3-y0)2，f为定焦数码相机的焦距，XA,YA,ZA为待测点在测量现场物方空间坐标系中的坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2,a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵 中的元素，(X′O,Y′O,Z′O)
为旋转坐标系与测量现场物方空间坐标系的相对位置，α′0为旋转坐标系在测量现场物方空间坐标系的初始角度；
[0040] 步骤10：结束。
[0041] 进一步的，所述的步骤3中拍摄全景影像的方法为每次旋转定焦数码相机相同的水平角度β＝(360/C)°拍摄影像，C为转动定焦数码相机的次数，直至覆盖360°水平角，共N张全景影像。
[0042] 进一步的，所述的步骤6中拍摄全景影像的方法为每次旋转定焦数码相机相同的水平角度β＝(360/C)°拍摄影像，C为转动定焦数码相机的次数，直至覆盖360°水平角，共T张全景影像，其中，T﹥0。
[0043] 与现有技术相比，本发明的有益效果是：一种基于定焦数码相机的旋转全景摄影测量方法和装置，当难以在被测物体上或周围布设控制点，但可以在其它位置或被测物对面布设控制点的情况下，利用少量控制点(3个以上)，可解算被测点的物方坐标，是解决现实场景中相机视场角小、控制点稀少难题的技术方案，是在困难场景进行近景摄影测量的一种有效的手段。
附图说明
[0044] 图1是本发明旋转全景摄影测量装置结构图；
[0045] 图2是本发明在全景三维控制场进行相机检校时，控制点和旋转全景相机拍摄位置的示意图；
[0046] 图3是本发明在现场布设的控制点和旋转全景相机拍摄位置的示意图。
具体实施方式
[0047] 下面结合附图所示的实例对本发明作进一步说明。
[0048] 如图1，一种基于定焦数码相机的旋转全景摄影测量装置，包括一个高精度旋转云台、一个机械固定支架、一台定焦数码相机；将定焦数码相机安装在机械固定支架上，所述的机械固定支架安装在高精度旋转云台上，整套装置称为旋转全景相机。
[0049] 所述的高精度旋转云台附有角度控制台。
[0050] 一种基于定焦数码相机的旋转全景相机的摄影测量方法，包括以下步骤：
[0051] 步骤1：在全景三维控制场中选择M个摄站，在每一摄站用定焦数码相机拍摄含控制点的影像，共M张影像；
[0052] 步骤2：计算定焦数码相机的内方位元素(f,x0,y0)、畸变参数(K1,K2,P1,P2)；
[0053] 提取M张影像上控制点的像点坐标(x,y)，利用已知的控制点像点坐标(x,y)、控制点在全景三维控制场的物方空间坐标(X,Y,Z)和共线方程式，见公式(1)，采用最小二乘的平差方法，解求定焦数码相机的内方位元素(f,x0,y0)、外方位元素(Xs,Ys,Zs,a1,a2,a3,b1,b2,b3,c1,c2,c3)、畸变参数(K1,K2,P1,P2)，f,x0,y0和K1,K2,P1,P2的结果作为真值参与后续计算；
[0054] 公式(1)如下所示：
[0055]
[0056] 式中，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，
[0057]
[0058] 式中，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r为M张影像上控制点的像点到像主点的距离，r＝(x-x0)2+(y-y0)2，f为定焦数码相机的焦距，Xs,Ys,Zs为投影中心S在全景三维控制场物方空间坐标系(G-X,Y,Z)中的坐标，a1,a2,a3,b1,b2,b3,c1,c2,c3为从像空间坐标系到全景三维控制场物方空间坐标系的旋转矩阵 中的元素；
[0059] 步骤3：在全景三维控制场中选择N个摄站，如图2所示，在每一摄站上用旋转全景相机拍摄360°水平角的全景影像，共N张全景影像；
[0060] 拍摄全景影像的方法为每次旋转定焦数码相机相同的水平角度β＝(360/C)°拍摄影像，C为转动定焦数码相机的次数，直至覆盖360°水平角，共N张全景影像。
[0061] 步骤4：计算旋转全景相机的旋转参数(US,VS,WS)和RS；
[0062] 提取N张全景影像上控制点的像点坐标(x1,y1)；根据步骤2中的(f,x0,y0)、(K1,K2,P1,P2)、全景三维控制场中控制点的像点坐标(x1,y1)、全景三维控制场中控制点的物方空间坐标(X,Y,Z)和公式(2)，采用最小二乘的平差方法解求旋转中心在全景三维控制场物方空间坐标系中的坐标(XO,YO,ZO)、旋转坐标系在全景三维控制场物方空间坐标系中的初始角度α0和旋转全景相机的旋转参数；旋转全景相机的旋转参数包括定焦数码相机投影中心与旋转中心的偏移量(US,VS,WS)和相对姿态RS；其中，(US,VS,WS)和RS对每张像片都是不变的，用于后续计算。
[0063] 公式(2)如下所示：
[0064]
[0065] 式中，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，
[0066]
[0067] 式中，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r1为N张影像上控制点的像点到像主点的距离，r1＝(x1-x0)2+(y1-y0)2，f为定焦数码相机的焦距，X′,Y′,Z′为全景三维控制场内控制点的物方空间坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2,a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵中的元素，(XO,YO,ZO)为旋转坐标系与全景三维控制场物方空间坐标系的相对位置，α0为旋转坐标系在全景三维控制场物方空间坐标系中的初始角度；
[0068] 步骤5：在测量现场布设3个以上的控制点Q1,Q2,Q3……；如图3所示；
[0069] 步骤6：在测量现场选择T个摄站，在每一摄站上拍摄含Q1,Q2,Q3……和待测点的测量现场的全景影像，共T张全景影像；
[0070] 拍摄全景影像的方法为每次旋转定焦数码相机相同的水平角度β＝(360/C)°拍摄影像，C为转动定焦数码相机的次数，直至覆盖360°水平角，共T张全景影像，其中，T﹥0。
[0071] 步骤7：计算测量现场中旋转全景相机的旋转中心在测量现场物方空间坐标系中的坐标(X′O,Y′O,Z′O)和旋转坐标系在测量现场物方空间坐标系中的初始角度α′0；
[0072] 提取测量现场的T张全景影像中控制点Q1,Q2,Q3……的像点坐标(x2,y2)；根据步骤2中的(f,x0,y0)、(K1,K2,P1,P2)、步骤4计算得到的景相机的旋转参数US,VS,WS、RS、控制点Q1,Q2,Q3……的像点坐标(x2,y2)、控制点在测量现场物方空间坐标系中的坐标(XQ,YQ,ZQ)和公式(3)，采用最小二乘的平差方法解求旋转全景相机在测量现场的旋转中心坐标(X′O,Y′O,Z′O)、旋转坐标系在测量现场物方空间坐标系中的初始角度α′0；其中，所述的(X′O,Y′O,Z′O)和α′0对同一摄站不变，用于后续计算。
[0073] 公式(3)如下所示：
[0074]
[0075] 式中，(x2,y2)为像点坐标，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r2为T张全景影像中控制点Q1,Q2,Q3,……的像点到像主点的距离r2＝(x2-x0)2+(y2-y0)2，f为定焦数码相机的焦距，XP,YP,ZP为测量现场内控制点的物方空间坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2,a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵 中的元素，(X′O,Y′O,
Z′O)为旋转坐标系与测量现场物方空间坐标系的相对位置，α′0为旋转坐标系在测量现场物方空间坐标系的初始角度；
[0076] 步骤8：由α′0和旋转角度β＝(360/C)°，根据公式(4)计算每张像片的旋转角度α；
[0077] 公式(4)如下所示：
[0078] α＝α′0+(i-1)β(i＝1,2,…，C) (4)
[0079] 其中，C为转动定焦数码相机的次数；
[0080] 步骤9：计算待测点在测量现场物方空间坐标系中的坐标(XA,YA,ZA)；
[0081] 提取测量现场的T张全景影像上待测点的像点坐标(x3,y3)；利用已知的f,x0,y0、K1,K2,P1,P2、(US,VS,WS)、RS、(x3,y3)、(X′O,Y′O,Z′O)、α和公式(5)，采用最小二乘的平差方法解求待测点在测量现场物方空间坐标系中的坐标(XA,YA,ZA)。
[0082] 公式(5)如下所示：
[0083]
[0084] 式中，(x3,y3)为像点坐标，(x0,y0)为像主点坐标，Δx,Δy为像点畸变差，K1,K2为径向畸变参数，P1,P2为偏心畸变参数，r3为T张全景影像上待测点的像点到像主点的距离，r3＝(x3-x0)2+(y3-y0
2
) ，f为定焦数码相机的焦距，XA,YA,ZA为待测点在测量现场物方空间坐标系中的坐标，(US,VS,WS)为投影中心S在旋转坐标系(O-U,V,W)中的坐标，a′1,a′2，a′3,b′1,b′2,b′3,c′1,c′2,c′3为从像空间坐标系到旋转坐标系的旋转矩阵 中的元素，(X′O,Y′O,Z′O)
为旋转坐标系与测量现场物方空间坐标系的相对位置，α′0为旋转坐标系在测量现场物方空间坐标系的初始角度；
[0085] 步骤10：结束。
