[发明专利]基于路标主动重观测的星表巡视器激光雷达定位方法

说明书

本发明公开了一种基于路标主动重观测的星表巡视器激光雷达定位方法，包括以下步骤：使用激光雷达和惯性测量单元松耦合的方式进行巡视器基本的定位功能；使用奇异值分解的方法对当前帧点云进行划分；根据当前探测视野的点云地貌定时进行显著性研判并提取重观测的路标；根据实时监测巡视器位姿状态估计情况确定路标重观测的触发时刻；使用层次分析法进行重观测路标优先级排序；最终使用点云匹配算法进行点云配准，更新巡视器的位姿。本发明能够实现星表巡视器漫游巡视任务中对历史路标的重新配准，进而将系统状态方差的预测值与当前观测值的融合更新，提高定位与建图的精确性。

技术领域

本发明属于星表漫游巡视任务中巡视器定位领域，具体涉及一种星表纹理贫瘠且呈现非结构环境下的巡视器主动重观测定位方法。

背景技术

星表巡视器在未知环境中执行探索任务，需要获取巡视器的精确位姿；但星表环境呈现纹理贫瘠、颜色单一、地貌非结构化的特点，在科学价值含量越高的地段地形越复杂（如月面的极区），因此星表巡视器需要具备较高的自主导航能力。表面的土壤非常松软而且崎岖不平，会影响巡视器行驶的平稳性，加重激光雷达定位与建图的运动畸变；此外月球光照条件不稳定，平均光强是地面的4.22倍，这种现象在极地环境更为明显，对基于视觉的导航影响较大。基于传统视觉或激光的导航定位算法鲜有针对性的应对策略，因此难以满足实际任务的导航精度及完备性的要求。

于是如何提高星表巡视器在极端环境下定位精度成为一个重要研究课题。初期的月面巡视器多采用IMU（Inertial measurement unit）和里程计相结合的航迹递推算法，如美国的月球流浪者，索杰纳号和俄罗斯的月球车1、2号，其定位误差均在10%R以上，后期的勇气号、机遇号、好奇号以及毅力号中在航迹推算定位方法基础上增加了视觉里程计，通过连续跟踪视觉特征点来解算巡视器的相对位姿信息，将定位误差提升至5%R以内，我国的玉兔号也采用了这种惯性与双目视觉结合的定位方法，在更稀疏的月表环境下实现了10%R以内的定位精度。但是这些方法尚处于自主或半自主模式，尚未涉及主动，无法很好地抑制误差的累积速率以及及时校正误差，影响了星表探测任务的实时性和可靠性。

发明内容

本发明的目的在于提供一种星表非结构环境下巡视器主动重观测定位方法，将巡视器位姿的预测值与当前观测值的融合更新，提高定位的精确性。

实现本发明目的的技术方案为：第一方面，本发明提供一种基于路标主动重观测的星表巡视器激光雷达定位方法，包括以下步骤：

步骤1，使用激光雷达和惯性测量单元松耦合的方式进行巡视器的定位，激光雷达和惯性测量单元测得实时绝对位姿，记录二者状态估计的差值作为状态估计不确定性的参照；

步骤2，使用奇异值分解的方法对当前帧点云进行划分，每隔固定时间段将当前帧点云划分为四个集合；

步骤3，对于步骤2划分的每个点云集合，构建由该集合点云数量熵和SVD分解奇异值组成的协方差矩阵，求取协方差矩阵的行列式进行显著性研判从而提取重观测路标；

步骤4，计算激光雷达以及惯性测量单元的状态估计值误差差值的2-范数，若该值大于预定阈值，则触发重观测；

步骤5，在巡视器行进过程中实时存储四处路标，在有新的路标被提取时，最早被提取的路标将被释放，在触发重观测后巡视器将停止行进，使用层次分析法对四处路标进行优先级排序，选择一处最佳路标进行配准；

步骤6，将步骤5得到的重观测路标与地图中对应路标进行配准，实现系统状态方差的预测值与当前观测值的融合更新。

第二方面，本发明提供一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述程序时实现第一方面所述的方法的步骤。

第三方面，本发明提供一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现第一方面所述的方法的步骤。