一种不规则外形物体空间姿态动态测量方法
【专利摘要】本发明涉及运动物体空间姿态动态测量【技术领域】，具体公开了一种不规则外形物体空间姿态动态测量方法。该方法包括：1）在被测物上设置光学靶标，并利用激光跟踪仪对所有光学靶标进行全局校准；2）利用相机测量系统标定技术对测量系统进行标定，并控制左右两相机同步采集测量图像，并通过图像处理技术提取光学靶标的图像坐标；3）利用步骤1、2所获得的光学靶标在被测物坐标系下的三维坐标和在测量坐标系下的三维坐标，获得旋转矩阵，获得被测物的三维空间姿态角。该测量方法，可以测量非轴对称的不规则外形的空间物体的瞬时空间三维姿态角；在测量范围2m×2m×2m的空间中，测量频率1000Hz的测量条件下，测量精度可达到空间角合成均方根误差小于0.05°。
【专利说明】-种不规则外形物体空间姿态动态测量方法
【技术领域】
[0001] 本发明属于运动物体空间姿态动态测量【技术领域】，具体涉及一种不规则外形物体 空间姿态动态测量方法。
【背景技术】
[0002] 空间姿态动态测量指利用传感器获取空间物体H维运动姿态参数，包括物体自身 坐标系相对于某固定参考坐标系的偏航角、俯仰角和滚转角。由于物体处于运动当中，接触 式测量方法不能解决上述测量问题，需要采用非接触式测量方法。其中，光学测量是主流的 空间姿态动态测量技术。现有的测量物体空间姿态的技术主要有利用光电经缔仪图像的中 轴线法、利用多相机的二维平面测量方法和利用单站图像基于数学迭代优化方法等。
[0003] (1)利用光电经缔仪图像的中轴线法
[0004] 利用光电经缔仪图像的中轴线法是首先假设被测物体是轴对称的，利用光电经缔 仪获取被测物体清晰轮廓的图像，利用图像处理技术对图像进行分析处理，提取被测物的 两条轮廓边界的直线方程，进而求出被测物体的中轴线方程，此直线与经缔仪照相系统的 光也唯一确定了一个空间平面；利用两台经缔仪测量就能得到两个平面，两平面在空间相 交，其交线就是被测物体的空间中轴线。得到物体的空间中轴线，便可进一步求出被测物体 的偏航角和俯仰角。
[0005] (2)利用多相机的二维平面测量方法
[0006] 利用多相机的二维平面测量方法是首先在被测物体上设置光学祀标，制造成像特 征，利用多台相机在空间不同位置对被测物体成像，获取光学祀标的图像，利用两个光学祀 标的质也构建一条直线，解算直线与相机坐标轴间的角度，进而求解被测物体的空间姿态 角在与相机成像平面平行的平面内的角分量，利用多台相机便可W获得被测物体在指定方 向上的姿态角变化。
[0007] (3)利用单站图像的数学迭代优化法
[0008] 利用单站图像的数学迭代优化法是利用单个影像经缔仪或相机获取被测物体的 图像，通过图像处理技术提取被测物轮廓上的边界角点，由摄影测量理论中共线条件约束 可知，像面上一点a与相机光也0的连线确定空间一条直线Oa，像点对应的物点A必在直 线Oa上。取被测目标上多于H个特征点，且已知任意两点间的距离，利用数学迭代优化的 方法便可求解出被测物体的空间H维姿态。
[0009] 现有的技术方法在面对不规则外形的物体空间H维姿态动态测量问题时，均表现 出一定局限性：
[0010] (1)利用光电经缔仪图像的中轴线法仅适用于轮廓线是直线的轴对称物体，对被 测物的形状规则性依赖性很强，对于非轴对称的不规则形体，算法稳定性和适应性受到很 大影响，测量精度严重降低，甚至出现方法失效的情况；另外，该方法完全依靠物体自身的 轮廓图像，由于轮廓提取精度是影响测量精度的关键因素之一，保证有效的测量精度对图 像处理技术提出很高要求，相应的算法复杂性显著提高。
[0011] (2)利用多相机的二维平面测量方法本质上属于二维测量，获得的测量结果是被 测物空间H维姿态角在某固定平面上的投影分量，投影平面是与成像相机像面平行的平 面。因此，该方法的测量结果不能真实的反映被测物的H维姿态角，需要在不同位置设置测 量相机获取感兴趣的方向上的姿态角，或通过多个方向的姿态角合成被测物体的H维空间 姿态角数据。
[0012] (3)利用单站图像的数学迭代优化方法是基于相机成像模型结合空间距离约束建 立数学方程，利用数学方法迭代优化求解被测物空间姿态参数。该方法的测量精度严重依 赖相机内参数、崎变参数的标定精度和空间约束距离的精度，与图像处理被测物边界角点 的精度密切相关。目前能够实现的精度不高，受图像质量影响显著。
【发明内容】
[0013] 本发明的目的在于提供一种不规则外形物体空间姿态动态测量方法，能够适用于 非轴对称的不规则外形的空间物体；通过设置测量特征，能够容易得到很高的特征提取精 度，能够实现真正的H维姿态角测量，且该方法对图像处理算法的要求低，实现简单，精度 商。
[0014] 本发明的技术方案如下：一种不规则外形物体空间姿态动态测量方法，该方法具 体包括如下步骤：
[0015] 步骤1、在被测物上设置光学祀标，并利用激光跟踪仪对所有光学祀标进行全局校 准；
[0016] 在被测物体表面的明显位置设有光学祀标，并保证被测物体运动过程中左右两台 相机均能够同时看到至少H个光学祀标；
[0017] 步骤2、利用相机测量系统标定技术对测量系统进行标定，并利用计算机控制左右 两相机同步采集测量图像，并通过图像处理技术提取光学祀标的图像坐标；
[0018] 步骤2. 1、利用相机测量系统标定技术标定出左右两台测量相机的内参数和外参 数；
[0019] 步骤2. 2、通过同步控制器控制两台测量相机W固定测量频率采集测量图像，并利 用质也法提取光学祀标的图像坐标；
[0020] 步骤2. 3、获取光学祀标在两台相机的测量图像中对应的质也坐标后，对成像镜头 的崎变进行校正补偿；
[0021] 步骤2. 4、完成崎变校正后，获得光学祀标在测量坐标系下的H维坐标；
[0022] 步骤3、利用步骤1、步骤2所获得的光学祀标在被测物坐标系下的H维坐标和在 测量坐标系下的H维坐标，获得被测物坐标系相对测量坐标系的旋转矩阵，从而获得被测 物的H维空间姿态角。
[0023] 所述的步骤1中利用激光跟踪仪对光学祀标进行全局校准的具体步骤为：
[0024] 利用激光跟踪仪测量H个光学祀标的空间H维坐标，并将激光跟踪仪坐标系设为 标定坐标系〇E-X义Z。，光学祀标在标定坐标系下的H维坐标为（X。（i)，Y。（i)，Z。（〇)， (i=l，2,3);利用激光跟踪仪测量被测物体的坐标系基准，建立被测物坐标系与标定坐标系 的转换关系，将光学祀标在标定坐标系下的H维坐标转换为在被测物坐标系下的H维坐标 (Xt (i)，Yt (i)，Zt (〇)，（i=l，2,3)〇
[0025] 所述的步骤2. 1中标定左右两台测量相机的内参数和外参数分别为：
[0026] 利用平面标定法标定出左右两台测量相机的内参数（(；<"，心"，fyW，fyW，k/"，k2" )，Pi("，P2。)）（i=l，2 ;1代表左相机，2代表右相机）和外参数R、T，其中，Cx("，Cy。)为i相机 的镜头主点位置；fyW，fyW为i相机的有效焦距；k/"，为i相机的镜头径向崎变系数. Pi("，P2")为i相机镜头切向崎变系数；R为旋转矩阵；T为平移矩阵。
[0027] 所述的步骤2. 2的具体步骤为：
[0028] 通过同步控制器控制两台测量相机W固定测量频率采集测量图像，通过直方图分 析、阔值分割图像处理手段滤除图像背景噪声，获得仅含有光学祀标的理想图像，利用质也 法提取光学祀标的图像坐标（Xi。)，yi(")和（Xr。)，y/") (i=l，2, 3)，其中，XI。)和yi。）为左 相机测量的第i个光学祀标的图像坐标，x/"，y/"为右相机测量的第i个光学祀标的图像 坐标。
[0029] 所述的步骤2. 3的具体步骤为：
[0030] 获取光学祀标在两台相机的测量图像中对应的质也坐标后，对成像镜头的崎变进 行校正补偿，校正模型为：
【权利要求】
1. 一种不规则外形物体空间姿态动态测量方法，其特征在于：该方法具体包括如下步 骤： 步骤1、在被测物上设置光学祀标，并利用激光跟踪仪对所有光学祀标进行全局校准； 在被测物体表面的明显位置设有光学祀标，并保证被测物体运动过程中左右两台相机 均能够同时看到至少H个光学祀标； 步骤2、利用相机测量系统标定技术对测量系统进行标定，并利用计算机控制左右两相 机同步采集测量图像，并通过图像处理技术提取光学祀标的图像坐标； 步骤2. 1、利用相机测量系统标定技术标定出左右两台测量相机的内参数和外参数； 步骤2. 2、通过同步控制器控制两台测量相机W固定测量频率采集测量图像，并利用质 也法提取光学祀标的图像坐标； 步骤2. 3、获取光学祀标在两台相机的测量图像中对应的质也坐标后，对成像镜头的崎 变进行校正补偿； 步骤2. 4、完成崎变校正后，获得光学祀标在测量坐标系下的H维坐标； 步骤3、利用步骤1、步骤2所获得的光学祀标在被测物坐标系下的H维坐标和在测量 坐标系下的H维坐标，获得被测物坐标系相对测量坐标系的旋转矩阵，从而获得被测物的 H维空间姿态角。
2. 根据权利要求1所述的一种不规则外形物体空间姿态动态测量方法，其特征在于： 所述的步骤1中利用激光跟踪仪对光学祀标进行全局校准的具体步骤为： 利用激光跟踪仪测量H个光学祀标的空间H维坐标，并将激光跟踪仪坐标系设为标定 坐标系〇E-X义Z。，光学祀标在标定坐标系下的H维坐标为（X。（i)，Y。（i)，Z。（i))，（i=l， 2,3);利用激光跟踪仪测量被测物体的坐标系基准，建立被测物坐标系与标定坐标系的转 换关系，将光学祀标在标定坐标系下的H维坐标转换为在被测物坐标系下的H维坐标（Xt (i)，Yt (i)，Zt (i))，（i=l，2,3)〇
3. 根据权利要求1所述的一种不规则外形物体空间姿态动态测量方法，其特征在于： 所述的步骤2. 1中标定左右两台测量相机的内参数和外参数分别为： 利用平面标定法标定出左右两台测量相机的内参数（(；<"，心"，f/"，k/"，P 1("，口2山）（i=l，2 ;1代表左相机，2代表右相机）和外参数R、T，其中，C/)，Cy("为i相机的 镜头主点位置车W，fyW为i相机的有效焦距；k/"，为i相机的镜头径向崎变系数. Pi")，P2")为i相机镜头切向崎变系数；R为旋转矩阵；T为平移矩阵。
4. 根据权利要求1述的一种不规则外形物体空间姿态动态测量方法，其特征在于：所 述的步骤2. 2的具体步骤为： 通过同步控制器控制两台测量相机W固定测量频率采集测量图像，通过直方图分析、 阔值分割图像处理手段滤除图像背景噪声，获得仅含有光学祀标的理想图像，利用质也法 提取光学祀标的图像坐标（XiW，yi (")和（x/"，yrW) (i = l，2,3)，其中，x/"和y/"为左相 机测量的第i个光学祀标的图像坐标，x/"，y/"为右相机测量的第i个光学祀标的图像坐 标。
5. 根据权利要求1述的一种不规则外形物体空间姿态动态测量方法，其特征在于：所 述的步骤2. 3的具体步骤为： 获取光学祀标在两台相机的测量图像中对应的质也坐标后，对成像镜头的崎变进行校 正补偿，校正模型为：
式中；X。、y。为目标质也校正后的图像坐标，X、y为目标质也校正前的图像坐标，5 X、 S y为镜头崎变；V k2为镜头径向崎变系数，Pi、P2为镜头切向崎变系数，Cy、Cy为镜头主点 位置，此6项参数通过相机系统标定后为已知量。
6. 根据权利要求1述的一种不规则外形物体空间姿态动态测量方法，其特征在于：所 述的步骤2. 4的具体步骤为： 完成崎变校正后，基于下式模型求解祀标在测量坐标系〇m-XmYmZm下的H维坐标：
式中；Xm、Ym、Zm为光学祀标在测量坐标系下的立维坐标，Xui、yul、Xut、yur为校正后的左、 右图像坐标，fyl、fyl、fyt、fyt分别表示左、右相机的有效焦距；矩阵R和T为：
fxl、fyl、f"、fyr和R、T通过标定后为已知量。
7. 根据权利要求1述的一种不规则外形物体空间姿态动态测量方法，其特征在于：所 述的步骤3的具体步骤为： 步骤3. 1、利用步骤2获得光学祀标在测量坐标系下的H维坐标（XmW，YmW，ZmW) (i=l，2, 3)后，结合步骤1获得的光学祀标在被测物坐标系下的H维坐标a/"，Y/"，z/") (i=l，2, 3)，求解被测物坐标系相对测量坐标系的旋转矩阵； 考虑坐标系的平移，将坐标系原点由点Pi平移到P2点，有关系式：
考虑坐标系的旋转，坐标系的旋转可通过旋转矩阵R描述，绕X、Y、Z轴的旋转矩阵为：
光学祀标在被测物坐标系与测量坐标系中H维坐标有如下关系： 口2 =化 l+t 通过3个光学祀标，通过去中也化处理，得到只含旋转分量的坐标，列出如下参数方 程，通过优化迭代可解算出旋转矩阵R ;
上述方程组中，rl，…，r9为旋转矩阵元素。X。。y。。Zm为目标初始点第i点去重也坐 标，Xu, y^，Zii为目标运动后对应第i点去重也坐标； 步骤3. 2、加入约束条件，获得被测物是H维空间姿态角； 加入如下约束：
优化迭代得到旋转矩阵R后，可反求出物体绕H轴的旋转角：
其中，a、目和y为被测物的S维空间姿态角，即俯仰角、滚转角和偏航角。
【文档编号】G01C1/00GK104422425SQ201310377247
【公开日】2015年3月18日 申请日期:2013年8月27日 优先权日:2013年8月27日
【发明者】郭磊, 梁雅军, 刘柯, 孙增玉, 宋金城, 陈晓晖 申请人:北京航天计量测试技术研究所, 中国运载火箭技术研究院