[发明专利]一种空间非合作目标激光点云ICP位姿匹配正确性判别方法及系统

权利要求书

1.一种空间非合作目标激光点云ICP位姿匹配正确性判别方法，其特征在于步骤如下：

(1)开展地面物理仿真试验，采用激光位姿敏感器，在地面模拟实际工况对空间非合作目标靶标进行扫描测量，获得空间非合作目标靶标的测量点云和空间非合作目标靶标的已知模型点云；

(2)根据步骤(1)获得的空间非合作目标靶标的测量点云和空间非合作目标靶标的标准点云，确定激光位姿敏感器的标准直方图分布H1；

(3)采用激光位姿敏感器，测量空间中真实的空间非合作目标，获得空间中真实的空间非合作目标的测量激光点云；

(4)根据空间中真实的空间非合作目标的标准激光点云和步骤(3)测量得到的空间中真实的空间非合作目标的测量激光点云，进行ICP位姿匹配，得到接近于空间中真实的空间非合作目标的标准激光点云的ICP匹配后激光点云；

(5)获得步骤(4)得到的ICP匹配后激光点云与空间中真实的空间非合作目标的标准激光点云上，每一组对应点的三维欧几里德空间距离；

(6)对步骤(5)每一组对应点的三维欧几里德空间距离，进行直方图分布统计，得到点云距离的标准直方图分布H2；

(7)根据步骤(2)激光位姿敏感器的标准直方图分布H1与步骤(6)点云距离标准直方图分布H2，判断两个直方图分布趋势是否一致，若一致则判定步骤(4)ICP位姿匹配正确，否则判定步骤(4)ICP位姿匹配不正确。

2.根据权利要求1所述的一种空间非合作目标激光点云ICP位姿匹配正确性判别方法，其特征在于：步骤(1)开展地面物理仿真试验，采用激光位姿敏感器，在地面模拟实际工况对空间非合作目标靶标进行扫描测量，获得非合作目标的测量激光点云和空间非合作目标靶标的已知模型点云，具体如下：

地面物理仿真试验是指：在激光位姿敏感器工作距离范围内，放置靶标，该靶标的位置和姿态相对于激光位姿敏感器测量坐标系已知，靶标的已知模型即已知位置和姿态的靶标，用于模拟空间非合作目标，并形成靶标的已知模型点云，用激光位姿敏感器，对靶标进行扫描测量，得到靶标的测量激光点云，即在地面获得模拟实际工况的空间非合作目标靶标的激光点云和靶标的已知模型点云。

3.根据权利要求1所述的一种空间非合作目标激光点云ICP位姿匹配正确性判别方法，其特征在于：步骤(2)根据步骤(1)获得的空间非合作目标靶标的测量点云和空间非合作目标靶标的标准点云，确定激光位姿敏感器的标准直方图分布H1，具体如下：

对空间非合作目标靶标的测量点云中的每个点，在空间非合作目标靶标的标准点云中，找到与其对应的距离其最近的点，形成对应的点云对，对每一组点云对，求三维欧几里德空间距离，即用空间非合作目标靶标的测量点云中的点坐标减去空间非合作目标靶标的标准点云中的点坐标，并求其绝对值。

4.根据权利要求1所述的一种空间非合作目标激光点云ICP位姿匹配正确性判别方法，其特征在于：步骤(3)采用激光位姿敏感器，测量空间中真实的空间非合作目标，获得非合作目标的测量激光点云，具体如下：

将激光位姿敏感器运用到空间非合作目标位姿测量的实际工作中，激光位姿敏感器通过对空间非合作目标发射激光，并接收被空间非合作目标表面反射回来的激光回波，测量激光从发射到接收到激光回波之间的时间，进而根据激光的传播速度，以及激光发射的方位角和俯仰角，计算得到空间非合作目标的相对于激光位姿敏感器测量坐标系的一个空间位置点，根据这一原理，在一个测量周期内，对激光位姿敏感器的整个测量视场依次完成激光的发射和激光回波的接收工作，即可形成一帧空间非合作目标的测量激光点云。