基于三维点云数据库模型的单目视觉测量与地面试验方法技术

本发明专利技术公开一种基于三维点云数据库模型的单目视觉测量与地面试验方法，目标的位置和姿态发生变化时，其在相机中的成像也会发生变化；利用三维重建得到目标的三维点云数据，通过相机标定得到相机的参数，采用OpenGL技术渲染生成目标模拟图像；通过构建模拟图像与实拍图像的关系实时确定目标的位置和姿态；地面试验设备包含分别用来安装目标模型及测量所使用的相机的两个试验台及其控制台，通过控制两个试验台的平动和转动来模拟太空环境中目标和飞行器的相对运动；将相机测量输出的位置和姿态与控制台的控制数据进行比较，进行地面试验验证。本发明专利技术可应用于空间失控失稳目标的在轨维修与服务，方法简单、精度高，流程清晰，易于实践，具有推广价值。

Monocular vision measurement and ground test method based on 3D point cloud database model

【技术实现步骤摘要】
基于三维点云数据库模型的单目视觉测量与地面试验方法
本专利技术涉及超近距离目标相对位姿单目视觉测量方法与地面试验，具体涉及一种基于三维点云数据库模型的单目视觉测量与地面试验方法。
技术介绍
人类空天活动的不断发展导致空间中航天器数量的不断增加。航天器长期运行在恶劣的空间环境中，不可避免的受到空间粒子、辐射等影响，使得其上搭载的设备老化甚至损坏，无法发挥航天器应有的功能，变成不受控的失效航天器，这会对空间中其他正常运行的航天器造成潜在的安全威胁。面对这样的情形，如何对这些不受控的失效航天器进行设备维修、轨道修正以及燃料加注等以使其能够继续正常运行工作，已经成为各国航天领域重点研究的问题之一，在轨服务技术随之产生，具有广泛的应用价值。对目标航天器进行在轨服务的前提是完成对它的检测识别以及相对位置和相对姿态的测量确定，这直接关系到任务的成败。利用双目视觉可以完成对目标的测量，但是双目视觉需要两台相机，设备系统复杂，而且需要进行两个相机的特征点的提取与匹配，算法复杂、运算量大。使用单目视觉具有设备少、算法简单、运算量小的优势。目前基于单目的视觉测量方法日趋成熟，常用的方法主要包括：基于特征点的目标姿态估计、利用非线性约束优化的特征值迭代求解位姿方法、利用航天器自身结构特征求解位姿方法以及基于连续多针空间非合作目标求解位姿方法。本专利技术提供的基于三维点云数据库模型的单目视觉测量与地面试验方法，根据目标的三维点云数据库进行位置和姿态的测量，并通过地面试验设备完成对位置和姿态测量数据的精度评价。目前没有发现同本专利技术类似技术的说明和报道，也尚未收集到国内外类似的资料。
技术实现思路
本专利技术的目的在于提供一种基于三维点云数据库模型的单目视觉测量与地面试验方法，其利用单目视觉完成对目标位置和姿态的测量并对测量值进行精度的评价；具体是根据目标的三维点云数据库进行位置和姿态的测量，并通过地面试验设备完成对位置和姿态测量数据的精度评价。为了达到上述目的，本专利技术通过以下技术方案实现：一种基于三维点云数据库模型的单目视觉测量与地面试验方法，包含以下步骤：S1、获取目标的三维点云数据并得到模拟的图像数据库；对测量所使用的相机进行标定，得到相机的参数，并通过渲染生成目标的模拟图像数据库；S2、将目标与测量所使用的相机分别安装在目标试验台与飞行器试验台，通过控制两个试验台至不同的位置和姿态，获得实拍图像；其中，将模拟图像数据库中与实拍图像重合比例最高的位置和姿态值作为实拍时刻的目标位置和姿态的初值；S3、基于所述步骤S2中目标的位置和姿态的初始值，进行三维点云的投影，获取二维投影图像，对图像进行轮廓提取，得到目标位置和姿态的粗值；重复步骤S2，直至位置和姿态变化小于预设的阈值或者到达迭代次数时停止迭代，输出目标最终的位置和姿态的测量值，作为位置和姿态的精确测量输出值；S4、将所述步骤S3中的位置和姿态的精确测量输出值与目标试验台与飞行器试验台显示的位置和姿态数据进行比较，完成对输出的目标的位置和姿态准确测量值的评价。优选地，所述步骤S1中，利用激光扫描仪得到所述目标的三维点云数据，以及通过OpenGL渲染生成目标的模拟图像数据库。优选地，所述步骤S1中，采用平面模板标定法对测量所使用的相机进行标定，包含：利用世界坐标系ow-xwywzw到像素坐标系o′-uv的坐标转换来表示：其中，分别表示像素坐标系u轴、v轴的有效焦距；dx表示单个像素在图像坐标系x轴方向的物理尺寸；dy表示单个像素在图像坐标系y轴方向的物理尺寸；f为相机的焦距；M为3×4的矩阵，为透视投影矩阵；M1为相机的内部参数，包括αx、αy、u0、v0四个参数，(u0,v0)为相机光心的像素坐标；M2为相机的外部参数；R表示世界坐标系与相机坐标系之间的平移关系，T表示世界坐标系与相机坐标系之间的旋转关系。优选地，所述目标试验台与所述飞行器试验台均为六自由度试验台。优选地，所述步骤S2中，进一步包含：将实拍图像的目标区域特征图像与模拟图像数据库中位于不同位置和姿态下的目标区域特征进行对比，确定两者之间的重合度，两者之间的重合度采用如下的公式判断：其中，FIA表示实拍图像所提取到的运动目标区域；FIS为模拟图像数据库目标区域特征集合中的目标区域；∩表示求交运算；|·|表示满足条件所统计得到的像素数目；当r大于给定的阈值时，则将模拟图像数据库的目标的位置和姿态分别作为实拍图像的位置和姿态的初始值。优选地，所述步骤S3中，进一步包含：利用所述步骤S2中的位置和姿态的初始值，进行三维点云数据的投影，获取二维投影图像，根据二维投影图像与模拟图像轮廓之间的关系，构建代价函数；所述代价函数是指二维投影图像中目标的轮廓与模拟图像中目标的轮廓的整体距离，求解代价函数最小时所对应的运动目标的位置和姿态即为目标当前迭代中的位置和姿态，并确定轮廓间的对应关系，代价函数的表达式：其中，pi为二维投影图像的轮廓，qi为模拟图像轮廓，N为图像轮廓的总数量。优选地，所述步骤S4中，在进行相机测量数据的评估时所需要的数据包含相机测量数据，试验台控制数据，相机测量系原点位置与相机端零位，目标特征坐标系原点位置与目标端零位。优选地，所述步骤S4中，进一步包含：相机测量数据与试验台控制数据的姿态转换关系如下：Csf＝CIsTCIf＝CbsTCSICTITCtf其中，Csf为相机测量得到的目标特征系到相机测量系的转换矩阵，转序3-1-2；CSI为相机端平台的姿态驱动矩阵，地面试验中相机端不转动，为单位阵；CTI为目标端平台的相对零位姿态驱动矩阵，转序3-2-1；Cbs、Ctf分别为寻找零位得到的相机安装矩阵和目标零位转动矩阵；CIf是本地坐标系到目标模型坐标系的转换矩阵；CIs是本地坐标系到单机测量坐标系的转换矩阵；相机测量数据与试验台控制数据的位置转换关系如下：rT-rS＝-CTIT·lT-CsIT·rst+CSIT·lS其中，CsIT＝CITCTbCbs；CIT＝CTIT，表示相对零位到目标端平台的姿态转换矩阵；rst为相机测量得到的测量系原点到目标特征系原点矢量在测量系下的分量；lT为相机端安装面中心到相机测量系原点的矢量；lS为目标端安装面中心到目标特征系原点的矢量；rT为目标试验台坐标系在本地坐标系下的坐标；rS为单机试验台坐标系在本地坐标系下的坐标。与现有技术相比，本专利技术的有益效果在于：本专利技术基于三维点云数据库模型的单目视觉测量与地面试验方法，利用目标的三维点云数据库模型完成位置和姿态的测量，并通过地面试验设备完成对位置和姿态测量数据的精度评价，得到了一种单目视觉测量位置和姿态的方法，并对位置和姿态的测量精度进行了评价，取得了单目视觉测量的新思路，适用于在轨维修和在轨服务领域；本专利技术的单目视觉测量方法算法简单、精度高，地面试验方法流程清晰，易于实践，具有一定的推广价值。...

【技术保护点】
1.一种基于三维点云数据库模型的单目视觉测量与地面试验方法，其特征在于，包含以下步骤：/nS1、获取目标的三维点云数据并得到模拟的图像数据库；对测量所使用的相机进行标定，得到相机的参数，并通过渲染生成目标的模拟图像数据库；/nS2、将目标与测量所使用的相机分别安装在目标试验台与飞行器试验台，通过控制两个试验台至不同的位置和姿态，获得实拍图像；其中，将模拟图像数据库中与实拍图像重合比例最高的位置和姿态值作为实拍时刻的目标位置和姿态的初值；/nS3、基于所述步骤S2中目标的位置和姿态的初始值，进行三维点云的投影，获取二维投影图像，对图像进行轮廓提取，得到目标位置和姿态的粗值；重复步骤S2，直至位置和姿态变化小于预设的阈值或者到达迭代次数时停止迭代，输出目标最终的位置和姿态的测量值，作为位置和姿态的精确测量输出值；/nS4、将所述步骤S3中的位置和姿态的精确测量输出值与目标试验台与飞行器试验台显示的位置和姿态数据进行比较，完成对输出的目标的位置和姿态准确测量值的评价。/n

【技术特征摘要】
1.一种基于三维点云数据库模型的单目视觉测量与地面试验方法，其特征在于，包含以下步骤：
S1、获取目标的三维点云数据并得到模拟的图像数据库；对测量所使用的相机进行标定，得到相机的参数，并通过渲染生成目标的模拟图像数据库；
S2、将目标与测量所使用的相机分别安装在目标试验台与飞行器试验台，通过控制两个试验台至不同的位置和姿态，获得实拍图像；其中，将模拟图像数据库中与实拍图像重合比例最高的位置和姿态值作为实拍时刻的目标位置和姿态的初值；
S3、基于所述步骤S2中目标的位置和姿态的初始值，进行三维点云的投影，获取二维投影图像，对图像进行轮廓提取，得到目标位置和姿态的粗值；重复步骤S2，直至位置和姿态变化小于预设的阈值或者到达迭代次数时停止迭代，输出目标最终的位置和姿态的测量值，作为位置和姿态的精确测量输出值；
S4、将所述步骤S3中的位置和姿态的精确测量输出值与目标试验台与飞行器试验台显示的位置和姿态数据进行比较，完成对输出的目标的位置和姿态准确测量值的评价。


2.如权利要求1所述的基于三维点云数据库模型的单目视觉测量与地面试验方法，其特征在于，
所述步骤S1中，利用激光扫描仪得到所述目标的三维点云数据，以及通过OpenGL渲染生成目标的模拟图像数据库。


3.如权利要求1所述的基于三维点云数据库模型的单目视觉测量与地面试验方法，其特征在于，
所述步骤S1中，采用平面模板标定法对测量所使用的相机进行标定，包含：利用世界坐标系ow-xwywzw到像素坐标系o′-uv的坐标转换来表示：



其中，分别表示像素坐标系u轴、v轴的有效焦距；dx表示单个像素在图像坐标系x轴方向的物理尺寸；dy表示单个像素在图像坐标系y轴方向的物理尺寸；f为相机的焦距；M为3×4的矩阵，为透视投影矩阵；M1为相机的内部参数，包括αx、αy、u0、v0四个参数，(u0,v0)为相机光心的像素坐标；M2为相机的外部参数；R表示世界坐标系与相机坐标系之间的平移关系，T表示世界坐标系与相机坐标系之间的旋转关系。


4.如权利要求1所述的基于三维点云数据库模型的单目视觉测量与地面试验方法，其特征在于，
所述目标试验台与所述飞行器试验台均为六自由度试验台。


5.如权利要求1所述的基于三维点云数据库模型的单目视觉测量与地面试验方法，其特征在于，
所述步骤S2中，进一步包含：
将实拍图像的目标区域特征图像与模拟图像数据库中位于不同位置和姿态下的目标区域特征进行对比，确定两者之间的重合度，两者之间的重合度采用如下的公式判...

【专利技术属性】
技术研发人员：刘礼诚，张丽敏，张晓彤，卢山，王焕杰，徐帷，
申请(专利权)人：上海航天控制技术研究所，
类型：发明
国别省市：上海;31