CN106225671A - 一种大型浮空器囊体体积测量装置的现场校准方法 - Google Patents

Abstract

本发明公开了一种大型浮空器囊体体积测量装置的现场校准方法，设定现场校准区域。构建地面控制点的局部三维坐标；在被测对象侧边的4个地面控制点设立测站，用激光全站仪和棱镜组件按照极坐标法观察得到被测对象侧边精密标定杆上所有准校点的局部三维坐标。建立校准参考坐标系；构建完整的现场校准场。测量装置对在校准参考坐标系中的精密标定杆上校准点进行拍摄获得图片，解算得到测量装置的每个相机的外方位元素，得到其位置和姿态完成校准工作。本发明解决了测量装置在任意场景下浮空器囊体体积测量的应用问题和测量装置使用中需要搬动情况下的校准问题。

Description

一种大型浮空器囊体体积测量装置的现场校准方法

技术领域

本发明涉及现场校准方法来源于摄影测量学领域,旨在解决一种浮空器囊体体积测量装置(基于普通工业相机的视觉测量装置)在现场应用中的参数校准问题。

背景技术

浮空器囊体体积测量装置是“基于人工标志和自然纹理成像的近影摄像测量原理”的工作系统，测量装置所用普通工业相机需要通过现场校准，确定相机外部参数，也是确定三维空间点和二维图像点间映射关系的过程。确定所有相机相对于校准参考坐标系(称为世界坐标系)的三维位置和方向(称为相机外参数)，是测量装置准确地从二维图像重建三维空间模型的关键，实现大型浮空器囊体体积测量的基础。

浮空器在飞试前，通过对浮空器囊体空间尺寸和囊体体积进行现场测量，通过评估其有效载荷条件下的平衡性能、气动特性，成为评价和验证设计参数的有效手段，对提高浮空器飞行品质产生重要影响。因此，研究一种在外场试验环境中，能适应于一定风场、气流变化影响条件下，能准确标准浮空器囊体体积测量装置的现场校准技术，成为本专利核心。

发明内容

本发明所要解决的技术问题是，针对现有技术不足，提供一种大型浮空器囊体体积测量装置的现场校准方法。

为解决上述技术问题，本发明所采用的技术方案是：一种大型浮空器囊体体积测量装置的现场校准方法，包括以下步骤：

1)在大型浮空器囊体周围10米以外布设P个地面控制点，为确保大型浮空器囊体体积测量装置的每台相机均可拍摄到2根以上的精密标定杆，在被测对象侧边1m以外布设2P根精密标定杆，设定现场校准区域；

2)采用1台激光全站仪和2个棱镜组件，依次在P个地面控制点设立测站，按照测回法测定P个地面控制点的边角网，进而计算平面坐标，按照三角高程测量法测定P个地面控制点的高程网，进而计算高程坐标，构成地面控制点的局部三维坐标；

3)在被测对象侧边的4个地面控制点设立测站，用激光全站仪和棱镜组件按照极坐标法观察得到大型浮空器囊体侧边精密标定杆上所有准校点的局部三维坐标；

4)将大型浮空器囊体头部的地面控制点A设为的原点，以大型浮空器囊体头部的地面控制点指向尾部方向定义为X轴正方向，垂直于X轴从地面指向天空的方向定义为Z轴正方向，Y轴定义符合右手定则，建立校准参考坐标系；将地面控制点、精密标定杆的局部三维坐标，统一在校准参考坐标系中精确求得所有校准点的相对位置关系，确定校准点的像点坐标及其对应的物方点坐标，从而构建完整的现场校准场；大型浮空器囊体体积测量装置对精密标定杆上的校准点进行拍摄获得图片，利用像点坐标和地面控制点三维坐标的对应关系，以及事先标定好的相机内方位元素，采用后方交会测量的方法解算得到测量装置的每个相机的外方位元素，得到大型浮空器囊体体积测量装置位置和姿态完成校准工作。

步骤4)中，校准参考坐标系的建立过程包括以下步骤：

1)以测站点A为第一个测站，并设为基准站，之后设站顺序依次为测站B、C、D、E、F，选择第一个测站点A为坐标原点，测站点A右方的观测点为x轴正方向，与x轴垂直的方向为y轴，确定AB方向为x轴正方向，与AB垂直且以F方向为y轴正方向，建立起平面xoy坐标系，然后将z轴设为水平面；

2)在测站点A设站，获得A、F两测站间的平距D_AF,A、B两测站间的平距D_AB，观测水平角∠AF_盘左、∠AF_盘右、∠AB_盘左、∠AB_盘右，竖直角仪器高I_A，棱镜高V_B；在测站B设站，获得B、A两测站间的平距D_BA,B、C两测站间的平距D_BC,水平角∠BA_盘左、∠BA_盘右、∠BC_盘左、∠BC_盘右，竖直角仪器高I_B，棱镜高V_C；同理，依次在测站C、D、E、F设站，获得一系列的测量数据；

3)计算平距：计算水平角：计算每个内角的改正数ν_β：ν_β＝—((∠A+∠B+∠C+∠D+∠E+∠F)-(m-2)×180°)/m；m＝6；对内角进行改正，得到改正后的内角：

4)设定测站点A的平面坐标为(0,0)，测站点B的平面坐标为(D_AB，0)，故α_AB＝0°，计算方位角：

5)对各测站的X、Y坐标进行计算：

$\begin{array}{cc}\begin{array}{c}\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\end{array}\right.\\ \left\{\begin{array}{c}{X}_B=D_{AB}\\ Y_B=0\end{array}\right.\end{array}& \begin{array}{c}\left\{\begin{array}{c}{X}_C=X_B+D_{BC}\·{\mathrm{cos\α}}_{BC}\\ Y_C=Y_B+D_{BC}\·{\mathrm{sin\α}}_{BC}\end{array}\right.\\ \left\{\begin{array}{c}{X}_D=X_C+D_{CD}\·{\mathrm{cos\α}}_{CD}\\ Y_D=Y_C+D_{CD}\·{\mathrm{sin\α}}_{CD}\end{array}\right.\\ \left\{\begin{array}{c}{X}_E=X_D+D_{DE}\·{\mathrm{cos\α}}_{DE}\\ Y_E=Y_D+D_{DE}\·{\mathrm{sin\α}}_{EF}\end{array}\right.\\ \left\{\begin{array}{c}{X}_F=X_E+D_{EF}\·{\mathrm{cos\α}}_{EF}\\ Y_F=Y_E+D_{EF}\·{\mathrm{sin\α}}_{EF}\end{array}\right.\end{array}\end{array};$

6)将AB方向的x轴绕测站点A逆时针旋转∠β，与AD为正方向的X轴重合，在校准参考坐标系中，设D的坐标为(D_AD，0)；而在以AB为x轴正方向的坐标中，D的坐标为(X_D，Y_D)，根据平面坐标系平移公式，求得：

7)进行坐标旋转：

$\begin{array}{c}\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_B=D_{AB}\·\cos \∠\mathrm{\β}-0\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_B=D_{AB}\·\sin \∠\mathrm{\β}+0\·\cos \∠\mathrm{\β}\end{array}\right.\end{array};$

$\begin{array}{c}\left\{\begin{array}{c}{X^{\′}}_C=X_C\·\cos \∠\mathrm{\β}+Y_C\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_C=X_C\·\sin \∠\mathrm{\β}+Y_C\·\cos \∠\mathrm{\β}\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_D=D_{AD}\\ {Y^{\′}}_D=0\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_E=X_E\·\cos \∠\mathrm{\β}-Y_E\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_E=X_E\·\sin \∠\mathrm{\β}+Y_E\·\cos \∠\mathrm{\β}\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_F=X_F\·\cos \∠\mathrm{\β}-Y_F\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_F=X_F\·\sin \∠\mathrm{\β}+Y_F\·\cos \∠\mathrm{\β}\end{array}\right.\end{array};$

8)计算各测站的Z坐标，设测站A的Z坐标Z_A＝0，根据三角高程测量公式，求得测站A、B、C、D、E、F的高程Z坐标；

9)最小化误差：

$\begin{array}{c}\[{(D_{AB}-\sqrt{{(X_A-X_B)}^2+{(Y_A-Y_B)}^2})}^2+{(D_{BC}-\sqrt{{(X_B-X_C)}^2+{(Y_B-Y_C)}^2})}^2+\\ {(D_{CD}-\sqrt{{(X_C-X_D)}^2+{(Y_C-Y_D)}^2})}^2+{(D_{DE}-\sqrt{{(X_D-X_E)}^2+{(Y_D-Y_E)}^2})}^2+\\ {(D_{EF}-\sqrt{{(X_E-X_F)}^2+{(Y_E-Y_F)}^2})}^2+{(D_{FA}-\sqrt{{(X_F-X_A)}^2+{(Y_F-Y_A)}^2})}^2\]\mathrm{\ϵ}+\\ \[{(\∠A-Q(F,A,B\left)\right)}^2+{(\∠B-Q(A,B,C\left)\right)}^2+{(\∠C-Q(B,C,D\left)\right)}^2+\\ {(\∠D-Q(C,D,E\left)\right)}^2+{(\∠E-Q(D,E,F\left)\right)}^2+{(\∠F-Q(E,F,A\left)\right)}^2\](1-\mathrm{\ϵ})\end{array},$

在约束条件为时最小，其中，Q(F，A，B)表示由测站点F、A、

B的X、Y平面坐标计算出的∠FAB，Q(A，B，C)···Q(E，F，A)同

理；令在约束条件为时

最小，其中，i＝A，B，C，D，E，F顺次循环；

10)在大型浮空器囊体侧边的4个地面控制点设立测站，用激光全站仪和棱镜组件按照极坐标法观察得到被测对象侧边精密标定杆上所有准校点的局部三维坐标,确立校准参考坐标系。

步骤4)中，利用测量相机对精密标定杆上的校准点进行拍摄，各测量相机的参数获取方法包括以下步骤：

1)各测量相机由IO卡控制曝光采集图像，每个测量相机保证能拍到至少4个校准点，在每张图像上量取至少3个校准点的像点坐标；

2)求得某一测量相机的外方位元素：X_S，Y_S，Z_S，ω，κ：

其中：

X⁰s、Y⁰s、Z⁰s、ω⁰、κ⁰代表外方位元素的近似值，取值如下：

Z⁰s＝f，n为单张影像上像点的个数；X_i、Y_i为单张影像上像点对应的地面平面坐标；

ΔX¹s，ΔY¹s，ΔZ¹s，Δω¹，Δκ¹为测量相机外方位元素改正数第一次迭代的结果值，ΔX²s，ΔY²s，ΔZ²s，Δω²，Δκ²为测量相机外方位元素改正数第二次迭代的结果值，依此类推；

ΔXs，ΔYs，ΔZs，Δω，Δκ为测量相机外方位元素近似值的改正数。

与现有技术相比，本发明所具有的有益效果为：本发明解决了测量装置在任意场景下浮空器囊体体积测量的应用问题，同时，解决了测量装置使用中需要搬动情况下的校准问题。本发明为准确测量大型浮空器囊体体积提供了技术基础，具有重要实现意义。

附图说明

图1为本发明—实施例现场校准整体示意图；

图2为本发明—实施例激光全站仪实际导线测量示意图；

图3为本发明—实施例精密标定杆上校准点坐标测量示意图；

图4为本发明—实施例各测量相机进行拍摄示意图；

其中，

1-测量装置，2-地面控制点，3-精密标定杆，4-激光全站仪，5-棱镜组件。

具体实施方式

本发明的具体实现过程如下：

1)布置现场校准区域

所述被测对象大型浮空器囊体周围10米以外布设6个地面控制点2，在被测对象侧边1m以外布设12根精密标定杆3，设定现场校准区域，确保大型浮空器囊体体积测量装置1的每台相机均可拍摄到2根以上的精密标定杆。

2)标测地面控制点的局部三维坐标

采用1台激光全站仪4和2个棱镜组件5，依次在6个地面控制点2设立测站，按照测回法测定6个地面控制点2的边角网，进而计算平面坐标，按照三角高程测量法测定6个地面控制点2的高程网，进而计算高程坐标，构成地面控制点2的局部三维坐标。

3)标测精密标定杆上所有校准点的局部三维坐标

在被测对象侧边的4个地面控制点设立测站，用激光全站仪4和棱镜组件5按照极坐标法观察得到被测对象侧边精密标定杆3上所有准校点的局部三维坐标。

4)校准参考坐标系与测量坐标系的统一技术

将被测对象头部的地面控制点A设为的原点，以被测对象头部的地面控制点指向尾部方向定义为X轴正方向，垂直于X轴从地面指向天空定义为Z轴正方向，Y轴定义符合右手定则，建立校准参考坐标系；将地面控制点2、精密标定杆3的局部三维坐标，统一在校准参考坐标系中精确求得所有准校点的相对位置关系，确定校准点的像点坐标及其对应的物方点坐标，从而构建完整的现场校准场。测量装置1对精密标定杆3上的校准点进行拍摄获得图片，利用像点坐标和地面控制点三维坐标的对应关系，以及事先标定好的相机内方位元素，采用后方交会测量的方法解算得到测量装置1的每个相机的外方位元素，得到其位置和姿态完成校准工作。

本发明原理如下:

(1)确定校准参考坐标系

测量系统的坐标系即相机的外方位元素所在的坐标系，而校准系统的坐标系是指以全站仪的第1个测站作为基准的坐标系。首先，所有的校准点(基准点)的坐标是通过全站仪观测的，并且全部换算到了全站仪的基准坐标系中；其次，相机的外方位元素是通过视控制点坐标为真值的单片空间后方交会方法计算得到的，后方交会的原理决定了外方位元素与校准点在同一个坐标系中。因此，测量系统坐标系与校准系统坐标系其实是同一个坐标系，即以全站仪为基准的坐标系。

以全站仪为基准的参考坐标系建立方法原理：

如图1所示，以测站点A为第一个测站，并设为基准站，之后设站顺序依次为测站B、C、D、E、F。设定AD方向为X轴，以被测对象头部的地面控制点A指向尾部方向的地面控制点D定义为X轴正方向，垂直于X轴从地面指向天空定义为Z轴正方向，Y轴定义符合右手定则，建立校准参考坐标系。XOY为校准参考坐标系

起初在实际测量中，选择第一个测站点A为坐标原点，其右方的观测点为x轴正方向，与X轴垂直方向为y轴，如图2为所示，确定AB方向为x轴正方向，与AB垂直且以F方向为y轴正方向，建立起平面xoy坐标系，xoy为实际测量坐标系，然后将z轴设为水平面。测量完毕后，将此实际测量坐标系逆时针旋转∠β，与校准参考坐标系重合，即完成校准参考坐标系的确定。

校准参考坐标系确立的具体步骤：

1)激光全站仪获取测量数据

在测站点A设站，获得得A、F两测站间的平距D_AF,A、B两测站间的平距D_AB,观测水平角∠AF_盘左、∠AF_盘右、∠AB_盘左、∠AB_盘右，竖直角仪器高I_A，棱镜高V_B；

在测站B设站，获得得B、A两测站间的平距D_BA,B、C两测站间的平距D_BC,水平角∠BA_盘左、∠BA_盘右、∠BC_盘左、∠BC_盘右，竖直角仪器高I_B，棱镜高V_C；

同理，依次在测站C、D、E、F设站，获得一系列的测量数据。

①平距计算

②水平角计算

2)每个内角的改正数ν_β

ν_β＝—((∠A+∠B+∠C+∠D+∠E+∠F)-(n-2)×180°)/n (3)

在这里，n＝6。

3)内角改正后的大小

$\left.\begin{array}{c}\∠A^{\′}=\∠A+{\mathrm{\ν}}_{\mathrm{\β}}\\ \∠B^{\′}=\∠B+{\mathrm{\ν}}_{\mathrm{\β}}\\ \mathrm{......}\\ \∠E^{\′}=\∠E+{\mathrm{\ν}}_{\mathrm{\β}}\\ \∠F^{\′}=\∠F+{\mathrm{\ν}}_{\mathrm{\β}}\end{array}\right\}---\left(4\right)$

4)方位角计算

设定测站点A的平面坐标为(0,0)，测站点B的平面坐标为(D_AB，0)，故α_AB＝0°，

5)各测站X、Y坐标计算

$\begin{array}{cc}\begin{array}{c}\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\end{array}\right.\\ \left\{\begin{array}{c}{X}_B=D_{AB}\\ Y_B=0\end{array}\right.\end{array}& \begin{array}{c}\left\{\begin{array}{c}{X}_C=X_B+D_{BC}\·{\mathrm{cos\α}}_{BC}\\ Y_C=Y_B+D_{BC}\·{\mathrm{sin\α}}_{BC}\end{array}\right.\\ \left\{\begin{array}{c}{X}_D=X_C+D_{CD}\·{\mathrm{cos\α}}_{CD}\\ Y_D=Y_C+D_{CD}\·{\mathrm{sin\α}}_{CD}\end{array}\right.\\ \left\{\begin{array}{c}{X}_E=X_D+D_{DE}\·{\mathrm{cos\α}}_{DE}\\ Y_E=Y_D+D_{DE}\·{\mathrm{sin\α}}_{DE}\end{array}\right.\\ \left\{\begin{array}{c}{X}_F=X_E+D_{EF}\·{\mathrm{cos\α}}_{EF}\\ Y_F=Y_E+D_{EF}\·{\mathrm{sin\α}}_{EF}\end{array}\right.\end{array}\end{array}---\left(6\right)$

6)旋转坐标系

①计算旋转角度

将AB方向的x轴绕测站点A逆时针旋转∠β，与AD为正方向的X轴重合。

在校准参考坐标系中，设D的坐标为(D_AD，0)；而在以AB为x轴正方向的坐标中，D的坐标为(X_D，Y_D)。

根据平面坐标系平移公式，列出下面的平移方程，见公式(7)：

$\left.\begin{array}{c}{D}_{AD}=X_{D}cos\∠\mathrm{\β}-Y_{D}sin\∠\mathrm{\β}\\ 0=X_D\·\sin \∠\mathrm{\β}+Y_D\·\cos \∠\mathrm{\β}\end{array}\right\}---\left(7\right)$

解得：

$\∠\mathrm{\β}=arcsin\left(\frac{-D_{AD}\·Y_D}{({X_D}^2+{Y_D}^2)}\right)---\left(8\right)$

②进行坐标旋转

$\begin{array}{c}\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_B=D_{AB}\·\cos \∠\mathrm{\β}-0\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_B=D_{AB}\·\sin \∠\mathrm{\β}+0\·\cos \∠\mathrm{\β}\end{array}\right.\end{array}---\left(9\right)$

$\begin{array}{c}\left\{\begin{array}{c}{X^{\′}}_C=X_C\·\cos \∠\mathrm{\β}+Y_C\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_C=X_C\·\sin \∠\mathrm{\β}+Y_C\·\cos \∠\mathrm{\β}\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_D=D_{AD}\\ {Y^{\′}}_D=0\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_E=X_E\·\cos \∠\mathrm{\β}-Y_E\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_E=X_E\·\sin \∠\mathrm{\β}+Y_E\·\cos \∠\mathrm{\β}\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_F=X_F\·\cos \∠\mathrm{\β}-Y_F\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_F=X_F\·\sin \∠\mathrm{\β}+Y_F\·\cos \∠\mathrm{\β}\end{array}\right.\end{array}---\left(10\right)$

7)计算各测站的Z坐标

设测站A的Z_A＝0，根据三角高程测量公式：

$Z_{i+1}=Z_i+D_i(i+1)\·tan{\∂}_i(i+1)+I_i-V_{i+1}---\left(11\right)$

其中，i＝A，B，C，D，E，F顺序循环；D_i(_i+1)为测站点i和测站点i+1之间的平距；为在测站i观测立在测站i+1上的棱镜的竖直角；I_i为在测站点i量取的仪器高；V_i+1为立在测站点i+1上的棱镜高。

根据上述的三角高程测量公式，求得测站A、B、C、D、E、F的高程Z坐标。

8)最小化误差

令：

$\begin{array}{c}\[{(D_{AB}-\sqrt{{(X_A-X_B)}^2+{(Y_A-Y_B)}^2})}^2+{(D_{BC}-\sqrt{{(X_B-X_C)}^2+{(Y_B-Y_C)}^2})}^2+\\ {(D_{CD}-\sqrt{{(X_C-X_D)}^2+{(Y_C-Y_D)}^2})}^2+{(D_{DE}-\sqrt{{(X_D-X_E)}^2+{(Y_D-Y_E)}^2})}^2+\\ {(D_{EF}-\sqrt{{(X_E-X_F)}^2+{(Y_E-Y_F)}^2})}^2+{(D_{FA}-\sqrt{{(X_F-X_A)}^2+{(Y_F-Y_A)}^2})}^2\]\mathrm{\ϵ}+\\ \[{(\∠A-Q(F,A,B\left)\right)}^2+{(\∠B-Q(A,B,C\left)\right)}^2+{(\∠C-Q(B,C,D\left)\right)}^2+\\ {(\∠D-Q(C,D,E\left)\right)}^2+{(\∠E-Q(D,E,F\left)\right)}^2+{(\∠F-Q(E,F,A\left)\right)}^2\](1-\mathrm{\ϵ})\end{array}---\left(12\right)$

在约束条件为：

$\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\\ Y_D=0\end{array}\right.---\left(13\right)$

下为最小。

其中，Q(F，A，B)表示由测站点F、A、B的X、Y平面坐标计算出的∠FAB，Q(A，B，C)···Q(E，F，A)同理。由于平距的测量误差为2mm,水平角测角误差为2″，故取ε＝0.5。

令：

$\[(I_i+D_i(i+1\left)tan{\∂}_i\right(i+1)-V_{i+1})-(Z_{i+1}-Z_i)\]---\left(14\right)$

在约束条件为：

$\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\\ Z_A=0\\ Y_D=0\end{array}\right.---\left(15\right)$

下为最小。

其中，i＝A，B，C，D，E，F顺次循环。

9)精密标定杆上校准点坐标计算

在被测对象侧边的4个地面控制点设立测站，用激光全站仪④和棱镜组件⑤按

照极坐标法观察得到被测对象侧边精密标定杆③上所有准校点的局部三维坐标。

如图3所示，在测站B设站，测站B与校准点a平距D_Ba，测得校准点a与BA方向的水平角θa，竖直角量得仪器高I_B，棱镜高则为V_a＝0。

由步骤4)得到方位角α_Ba＝α_AB+θa-180°。

由步骤5)得到校准点a的平面坐标：

$\left.\begin{array}{c}Xa=X_B+D_{Ba}{\mathrm{cos\α}}_{Ba}\\ Ya=Y_B+D_{Ba}{\mathrm{sin\α}}_{Ba}\end{array}\right\}---\left(16\right)$

由步骤7)得到校准点a的Z坐标：

$Za=I_B+D_{Ba}tan{\∂}_{Ba}-V_a---\left(17\right)$

同理，由步骤4)、5)、7)可得到其它校准点的三维坐标。

到此，根据步骤1)、2)...8)、9)得到校准参考坐标系的测站点和校准点的三维坐标，完全确立了校准参考坐标系。

3、确定各测量相机的参数

如图4所示，测量装置①中的各测量相机对精密标定杆③上的校准点进行拍摄，获得校准点的影像，在获取的影像上量取各个校准点的像点坐标。利用各个校准点的像点坐标和其相对应的地面控制点三维坐标，以及事先标定好的相机内方位元素，采用后方交会测量的方法解算得到测量装置①的每个相机的外方位元素，得到其位置和姿态完成校准工作。

具体的各测量相机参数获取方法如下：

1)量测校准点的像点坐标

测量装置①中的各测量相机由IO卡控制曝光采集图像，每个相机保证能拍到至少4个校准点。在每张图像上量取至少3个校准点的像点坐标，本方法量取4个校准点。如在一张图像上量取到校准点a、b、c、d的像点坐标：

a(x_a,y_a)、b(x_b,y_b)、c(x_c,y_c)、d(x_d,y_d)。

2)后方交会解算相机的外方位元素

相机的外方位元素有6个：X_S，Y_S，Z_S，ω，κ。由校准点的像点坐标及其对应的控制点三维坐标，已知的相机的内方位元素(xo,yo,f)，依据共线条件方程一般式：

$\begin{array}{c}x-x_0=-f\frac{a_1(X_A-X_S)+b_1(Y_A-Y_S)+c_1(Z_A-Z_S)}{a_3(X_A-X_S)+b_3(Y_A-Y_S)+c_3(Z_A-Z_S)}\\ y-y_0=-f\frac{a_2(X_A-X_S)+b_2(Y_A-Y_S)+c_2(Z_A-Z_S)}{a_3(X_A-X_S)+b_3(Y_A-Y_S)+c_3(Z_A-Z_S)}\end{array}---\left(18\right)$

列出检校点的共线方程：

$\begin{array}{c}x-xo=-f\frac{a_1(X-X_S)+b_1(Y-X_S)+c_1(Z-X_S)}{a_3(X-X_S)+b_3(Y-X_S)+c_3(Z-X_S)}\\ y-yo=-f\frac{a_2(X-X_s)+b_2(Y-X_s)+c_2(Z-X_S)}{a_3(X-X_S)+b_3(Y-X_S)+c_3(Z-X_S)}\end{array}---\left(19\right)$

具体的为：

$\left.\begin{array}{c}xa-xo=-f\frac{a_1(Xa-X_S)+b_1(Ya-X_S)+c_1(Za-X_S)}{a_3(Xa-X_S)+b_3(Ya-X_S)+c_3(Za-X_S)}\\ ya-yo=-f\frac{a_2(Xa-X_S)+b_2(Ya-X_S)+c_2(Za-X_S)}{a_3(Xa-X_S)+b_3(Ya-X_S)+c_3(Za-X_S)}\\ xb-xo=-f\frac{a_1(Xb-X_S)+b_1(Yb-X_S)+c_1(Zb-X_S)}{a_3(Xb-X_S)+b_3(Yb-X_S)+c_3(Zb-X_S)}\\ yb-yo=-f\frac{a_2(Xb-X_S)+b_2(Yb-X_S)+c_2(Zb-X_S)}{a_3(Xb-X_S)+b_3(Yb-X_S)+c_3(Zb-X_S)}\\ \mathrm{......}\end{array}\right\}---\left(20\right)$

其中，

相机的外方位元素有6个，即为6个未知数，由一个像点坐标可以列2个方程式，故至少需要3个像点才可进行方程求解。本方法选用4个像点进行求解，以第一个相机的图像上校准点为a、b、c、d例。

①共线方程线性化

②误差方程式的建立

V＝AX-L,P(25)

其中，P为像点观测值的权，

其它符号对应每一个像点为：

V_i＝[v_x v_y]^T (26)

Li＝[lx ly]^T＝[x-(x),y-(y)]^T (27)

$A_i=\left[\begin{array}{cccccc}{a}_{11}& a_{12}& a_{13}& a_{14}& a_{15}& a_{16}\\ a_{21}& a_{22}& a_{23}& a_{24}& a_{25}& a_{26}\end{array}\right]---\left(28\right)$

③法方程求解

法方程式：

A^TPAX＝A^TPL (29)

法方程解：

X＝(A^TPA)-¹A^TPL (30)

从而可求出相机外方位元素近似值的该正数ΔXs，ΔYs，ΔZs，Δω，Δκ。

④改正后的外方位元素

由于共线方程在线性化过程中各系数取自泰勒级数展开式的一次项，且未知数的初值一般都是比较粗糙的，因此计算需要迭代进行。每次迭代时用未知数近似值与上次迭代计算的改正后数之和作为新的近似值，重复计算过程，求出新的该正数，这样反复趋近，直到该正数小于某一个限值为止，最后得出相机的6个外方位元素的解：

其中，Z⁰s＝f，

n为单张影像上像点的个数；X_i、Y_i为单张影像上像点对应的地面平面坐标。

至此，根据步骤①、②、③、④可求得一个相机的6个外方位元素，同理，重复步骤①、②、③、④，可将所有相机的外方位元素求出，完成相机参数的测量。

Claims (3)

1.一种大型浮空器囊体体积测量装置的现场校准方法，其特征在于，包括以下步骤：

1)在大型浮空器囊体周围10米以外布设P个地面控制点，为确保大型浮空器囊体体积测量装置的每台相机均可拍摄到2根以上的精密标定杆，在被测对象侧边1m以外布设2P根精密标定杆，设定现场校准区域；

2)采用1台激光全站仪和2个棱镜组件，依次在P个地面控制点设立测站，按照测回法测定P个地面控制点的边角网，进而计算平面坐标，按照三角高程测量法测定P个地面控制点的高程网，进而计算高程坐标，构成地面控制点的局部三维坐标；

3)在被测对象侧边的4个地面控制点设立测站，用激光全站仪和棱镜组件按照极坐标法观察得到大型浮空器囊体侧边精密标定杆上所有准校点的局部三维坐标；

4)将大型浮空器囊体头部的地面控制点A设为的原点，以大型浮空器囊体头部的地面控制点指向尾部方向定义为X轴正方向，垂直于X轴从地面指向天空的方向定义为Z轴正方向，Y轴定义符合右手定则，建立校准参考坐标系；将地面控制点、精密标定杆的局部三维坐标，统一在校准参考坐标系中精确求得所有校准点的相对位置关系，确定校准点的像点坐标及其对应的物方点坐标，从而构建完整的现场校准场；大型浮空器囊体体积测量装置对精密标定杆上的校准点进行拍摄获得图片，利用像点坐标和地面控制点三维坐标的对应关系，以及事先标定好的相机内方位元素，采用后方交会测量的方法解算得到测量装置的每个相机的外方位元素，得到大型浮空器囊体体积测量装置位置和姿态完成校准工作。

2.根据权利要求1所述的大型浮空器囊体体积测量装置的现场校准方法，其特征在于，步骤4)中，校准参考坐标系的建立过程包括以下步骤：

1)以测站点A为第一个测站，并设为基准站，之后设站顺序依次为测站B、C、D、E、F，选择第一个测站点A为坐标原点，测站点A右方的观测点为x轴正方向，与x轴垂直的方向为y轴，确定AB方向为x轴正方向，与AB垂直且以F方向为y轴正方向，建立起平面xoy坐标系，然后将z轴设为水平面；

2)在测站点A设站，获得A、F两测站间的平距D_AF,A、B两测站间的平距D_AB，观测水平角∠AF_盘左、∠AF_盘右、∠AB_盘左、∠AB_盘右，竖直角仪器高I_A，棱镜高V_B；在测站B设站，获得B、A两测站间的平距D_BA,B、C两测站间的平距D_BC,水平角∠BA_盘左、∠BA_盘右、∠BC_盘左、∠BC_盘右，竖直角仪器高I_B，棱镜高V_C；同理，依次在测站C、D、E、F设站，获得一系列的测量数据；

3)计算平距：计算水平角：计算每个内角的改正数ν_β：ν_β＝—((∠A+∠B+∠C+∠D+∠E+∠F)-(m-2)×180°)/m；m＝6；对内角进行改正，得到改正后的内角：

4)设定测站点A的平面坐标为(0,0)，测站点B的平面坐标为(D_AB，0)，故α_AB＝0°，计算方位角：

5)对各测站的X、Y坐标进行计算：

$\begin{array}{cc}\begin{array}{c}\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\end{array}\right.\\ \left\{\begin{array}{c}{X}_B=D_{AB}\\ Y_B=0\end{array}\right.\end{array}& \begin{array}{c}\left\{\begin{array}{c}{X}_C=X_B+D_{BC}\·{\mathrm{cos\α}}_{BC}\\ Y_C=Y_B+D_{BC}\·{\mathrm{sin\α}}_{BC}\end{array}\right.\\ \left\{\begin{array}{c}{X}_D=X_C+D_{CD}\·{\mathrm{cos\α}}_{CD}\\ Y_D=Y_C+D_{CD}\·{\mathrm{sin\α}}_{CD}\end{array}\right.\\ \left\{\begin{array}{c}{X}_E=X_D+D_{DE}\·{\mathrm{cos\α}}_{DE}\\ Y_E=Y_D+D_{DE}\·{\mathrm{sin\α}}_{DE}\end{array}\right.\\ \left\{\begin{array}{c}{X}_F=X_E+D_{EF}\·{\mathrm{cos\α}}_{EF}\\ Y_F=Y_E+D_{EF}\·{\mathrm{sin\α}}_{EF}\end{array}\right.\end{array}\end{array};$

6)将AB方向的x轴绕测站点A逆时针旋转∠β，与AD为正方向的X轴重合，在校准参考坐标系中，设D的坐标为(D_AD，0)；而在以AB为x轴正方向的坐标中，D的坐标为(X_D，Y_D)，根据平面坐标系平移公式，求得：

7)进行坐标旋转：

$\begin{array}{c}\left\{\begin{array}{c}{X}_A=0\\ Y_A=0\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_B=D_{AB}\·\cos \∠\mathrm{\β}-0\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_B=D_{AB}\·\sin \∠\mathrm{\β}+0\·\cos \∠\mathrm{\β}\end{array}\right.\end{array};$

$\begin{array}{c}\left\{\begin{array}{c}{X^{\′}}_C=X_C\·\cos \∠\mathrm{\β}-Y_C\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_C=X_C\·\sin \∠\mathrm{\β}+Y_C\·\cos \∠\mathrm{\β}\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_D=D_{AD}\\ {Y^{\′}}_D=0\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_E=X_E\·\cos \∠\mathrm{\β}-Y_E\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_E=X_E\·\sin \∠\mathrm{\β}+Y_E\·\cos \∠\mathrm{\β}\end{array}\right.\\ \left\{\begin{array}{c}{X^{\′}}_F=X_F\·\cos \∠\mathrm{\β}-Y_F\·\sin \∠\mathrm{\β}\\ {Y^{\′}}_F=X_F\·\sin \∠\mathrm{\β}+Y_F\·\cos \∠\mathrm{\β}\end{array}\right.\end{array};$

8)计算各测站的Z坐标，设测站A的Z坐标Z_A＝0，根据三角高程测量公式，求得测站A、B、C、D、E、F的高程Z坐标；

9)最小化误差：

$\begin{array}{c}\[{(D_{AB}-\sqrt{{(X_A-X_B)}^2+{(Y_A-Y_B)}^2})}^2+{(D_{BC}-\sqrt{{(X_B-X_C)}^2+{(Y_B-Y_C)}^2})}^2+\\ {(D_{CD}-\sqrt{{(X_C-X_D)}^2+{(Y_C-Y_D)}^2})}^2+{(D_{DE}-\sqrt{{(X_D-X_E)}^2+{(Y_D-Y_E)}^2})}^2+\\ {(D_{EF}-\sqrt{{(X_E-X_F)}^2+{(Y_E-Y_F)}^2})}^2+{(D_{FA}-\sqrt{{(X_F-X_A)}^2+{(Y_F-Y_A)}^2})}^2\]\mathrm{\ϵ}+\\ \[{(\∠A-Q(F,A,B\left)\right)}^2+{(\∠B-Q(A,B,C\left)\right)}^2+{(\∠C-Q(B,C,D\left)\right)}^2+\\ {(\∠D-Q(C,D,E\left)\right)}^2+{(\∠E-Q(D,E,F\left)\right)}^2+{(\∠F-Q(E,F,A\left)\right)}^2\](1-\mathrm{\ϵ})\end{array},$

在约束条件为时最小，其中，Q(F，A，B)表示由测站点F、A、B的X、Y平面坐标计算出的∠FAB，Q(A，B，C)…Q(E，F，A)同理；令在约束条件为时最小，其中，i＝A，B，C，D，E，F顺次循环；

10)在大型浮空器囊体侧边的4个地面控制点设立测站，用激光全站仪和棱镜组件按照极坐标法观察得到被测对象侧边精密标定杆上所有准校点的局部三维坐标,确立校准参考坐标系。

3.根据权利要求1所述的大型浮空器囊体体积测量装置的现场校准方法，其特征在于，步骤4)中，利用测量相机对精密标定杆上的校准点进行拍摄，各测量相机的参数获取方法包括以下步骤：

1)各测量相机由IO卡控制曝光采集图像，每个测量相机保证能拍到至少4个校准点，在每张图像上量取至少3个校准点的像点坐标；

2)求得某一测量相机的外方位元素：X_S，Y_S，Z_S，ω，κ：

其中：

X⁰s、Y⁰s、Z⁰s、ω⁰、κ⁰代表外方位元素的近似值，取值如下：

Z⁰s＝f，n为单张影像上像点的个数；X_i、Y_i为单张影像上像点对应的地面平面坐标；

ΔX¹s，ΔY¹s，ΔZ¹s，Δω¹，Δκ¹为测量相机外方位元素改正数第一次迭代的结果值，ΔX²s，ΔY²s，ΔZ²s，Δω²，Δκ²为测量相机外方位元素改正数第二次迭代的结果值，依此类推；

ΔXs，ΔYs，ΔZs，Δω，Δκ为测量相机外方位元素近似值的改正数。