一种基于视觉标定及坐标转换的测量系统整体校准方法
【技术领域】
[0001] 本发明是一种基于视觉标定及坐标转换的测量系统整体校准方法，对自动跟踪与 测量系统进行各坐标系之间的转换和整个系统内部参数校准，属于测试技术领域。
【背景技术】
[0002] 自动跟踪与测量系统包含大地、场合、转台、相机等4个主要坐标系，准确标定出 转台坐标系与大地坐标系的转换关系或场地坐标系，才能实现各坐标系之间的转换，是准 确得出测量数据的基础。由于转台构架、承重和全向动态等特点，采用惯性器件的标定方 式，存在一定的安全问题，由此发明一种基于视觉标定及坐标转换的自动跟踪与测量系统 整体的校准方法，确保系统的测量精度。
【发明内容】
[0003] 本发明创造的目的是设计基于视觉标定及坐标转换的测量系统整体校准方法，在 自动跟踪与测量系统中，对系统进行整体校准，在实施跟踪与测量过程中，确保系统测量精 度，为飞行安全提供有效保证。
[0004] 本发明是通过下述技术方案实现的：基于视觉标定及坐标转换的测量系统整体校 准方法，包括以下步骤： (1) 进行相机内外参数的标定； (2) 转台坐标系与相机坐标系之间的关系Hrc手眼标定，利用转台手抓和相机相对关 系不变的性质，固定靶标位置，在保证靶标在视野内的条件下，多次转动转台，则第i次和 第j次图像相对与第一次的外参数计算出手抓和相机间的R和t。从而求出转台与相机之 间的转换矩阵Hrc0
[0005] (3)转台坐标系与场地坐标系转换关系Hpr或者转台坐标系与大地坐标系转换关 系Hrg的标定，根据实际情况，选择基于视觉的标定方法，即可得出Hpr或者Hrg。
[0006] (4)在取得Hrg、Hpr、Hrc的基础上，就可以将相机、转台、场地、大地四个坐标系统 统一起来。
[0007] (5)控制转台拍摄目标，结合转台方位、俯仰角度与镜头焦距信息，即可将目标相 关信息映射到特定坐标系下，实现预定任务。
[0008] 在所述步骤1中，相机的内外参数标定是将设计好的高精度黑白靶标置于相机前 (距离视其占整个画面比例而定，需要让靶标位置可以遍及视场的各个方位)，相机的位置 保持不变，通过改变靶标来获得图像，在每个合适的位置进行拍摄。然后再计算机上，对每 个位置的靶标图像进行角点提取，可获得相应的单应矩阵。当所用图像的单应矩阵得出后， 利用其与内参的关系列出矩阵方程并奇异值分解得出内参，进而求出外参。
[0009] 所述步骤3中，转台坐标与场地坐标系转换关系Hpr或者转台坐标系与大地坐标 系转换关系Hrg的标定，根据实际情况，选择基于视觉的标定方法，即可得出Hrg或者Hpr。 基于视觉的标定方法包括角度转换、手眼标定、场地坐标系与手抓坐标系转换。
[0010] (1)角度转换 上述过程中总线传输到计算机上的是两个方向的角度，而这个角度换算成R坐标的形 式有公式如下：
上式中0代表光轴的旋转角度，实际为〇，巾为相机光轴在手抓坐标系的XY平面上的 投影与X轴的夹角，巾为相机光轴和手抓坐标系的Z坐标之间的夹角。
[0011] (2)手眼标定 在准确得到转台手抓和场地坐标系转换关系前，要进行转台手抓和相机的手眼标定。 手眼的标定基本公式为： rc*r=r*rd 氺t+tD=R氺tD+tD 其中R和t为所求，其他部分由标定得出。由于有两次位置的摆放，所以会有四个关 系式。基于手抓和相机的相对关系不变，所以至少要有两次位置的摆放，为了保证标定的精 度，可进行多次位置的摆放标定。传统的手眼标定是通过移动手抓的位置来进行的，由于这 里的标定是以手抓为坐标原点，所以通过移动靶标也可以达到同样的效果，只是R和t的简 单转化关系。
[0012] 靶标的摆放相对位置是已知的，如此可以验证标定的精度，并加以验证和误差矫 正。（3)场地坐标系与手抓坐标系转换 ①旋转参数计算：
其中RcipI中的（aDh，C1)可由下式计算得到JZSplp2=K(X2-X1)i+(Y2I1)i+(Z2-Z1)k}，记 作aii+bd+Cik;式中：Splp2-Pjlj卩2的距离P^(X1, Z1),P2=(x2,y2, Z3)是构造出的新坐标 系的三维坐标，同理得到（a'2,b'2,c'2)和（a3,b3,C3); ②确定平移量的初值，采用任意控制点ni坐标，有公式：
已知未作变化3点Pl、P2、P3在坐标系O-XYZ和0' -X'Y'Z'的坐标分别为（Xi，Y1,Z1)，（Xn1,Yn1，Zn1),i=l，2,3。
[0013] 本发明有益效果：本发明基于视觉标定方法及坐标转换的测量系统整体校准方 法，能够在各种阵地和场合对系统进行精度校准，测量方法方便、快捷，不需借助其他设备， 消除系统动态操作过程中的各种安全隐患；另外，通过使用本发明的方法对自动跟踪与测 量系统进行校准，节省了大量的人力、物力和时间，既满足测量系统的精度要求，同时也可 以系统架设、迀移、定期维护等各种场合应用进行系统精度重新校准，有效保证自动跟踪与 测量系统的监测精度，保证飞机的飞行安全。
[0014]
【附图说明】： 图1视觉标定示意图。
[0015] 图2坐标系转换关系。
【具体实施方式】
[0016] 本发明基于视觉标定及坐标转换的测量系统整体校准方法，包括以下步骤： (1) 进行相机内外参数的标定； (2) 转台坐标系与相机坐标系之间的关系Hrc手眼标定，利用转台手抓和相机相对关 系不变的性质，固定靶标位置，在保证靶标在视野内的条件下，多次转动转台，则第i次和 第j次图像相对与第一次的外参数计算出手抓和相机间的R和t。从而求出转台与相机之 间的转换矩阵Hrc0
[0017] (3)转台坐标系与场地坐标系转换关系Hpr或者转台坐标系与大地坐标系转换关 系Hrg的标定，根据实际情况，选择基于视觉的标定方法，即可得出Hpr或者Hrg。
[0018] (4)在取得Hrg、Hpr、Hrc的基础上，就可以将相机、转台、场地、大地四个坐标系统 统一起来。
[0019] (5)控制转台拍摄目标，结合转台方位、俯仰角度与镜头焦距信息，即可将目标相 关信息映射到特定坐标系下，实现预定任务。
[0020] 在所述步骤1中，相机的内外参数标定是将设计好的高精度黑白靶标置于相机前 (距离视其占整个画面比例而定，需要让靶标位置可以遍及视场的各个方位)，相机的位置 保持不变，通过改变靶标来获得图像，在每个合适的位置进行拍摄。然后再计算机上，对每 个位置的靶标图像进行角点提取，可获得相应的单应矩阵。当所用图像的单应矩阵得出后， 利用其与内参的关系列出矩阵方程并奇异值分解得出内参，进而求出外参。
[0021] 所述步骤3中，转台坐标与场地坐标系转换关系Hpr或者转台坐标系与大地坐标 系转换关系Hrg的标定，根据实际情况，选择基于视觉的标定方法，即可得出