本发明涉及定位技术领域，尤其涉及一种地下环境定位方法、装置、设备及存储介质。
背景技术：
近年来，地面无人驾驶项目发展迅速，对提高整个交通行业安全及效率有重要作用。而地下封闭受限空间的特殊环境，是实现无人驾驶快速落地的首选场景，能大幅度改善作业的安全性并提高地下作业效率，进而为企业创造出更大的经济效益，其中，地下环境中的精确定位是关键。
虽然在空旷环境下基于gnss(全球定位卫星系统)的定位能实现厘米级的定位精度，但对地下矿山、地铁、管廊、消防、人防等地下特殊环境，由于无法接收到gps(全球定位系统)信号，使得地下定位困难增加。针对地下环境的定位问题，早在20世纪90年代初就已应用低频电磁引导、超声波传感测量引导、基于视觉信标导航等进行地下定位与连续跟踪。此外，基于wi-fi(wireless-fidelity，无线保真)定位、蓝牙定位、rfid(radiofrequencyidentification，无线射频识别)定位、uwb(ultrawideband)定位、红外技术、超声波等定位技术也有广泛应用。但上述定位技术都需要在地下环境中安装相应的辅助定位装置，虽能提高定位精度，但是需要增加大量的设备与维护费用，同时由于地下空间环境粗糙，容易造成定位过程中的累计误差，特别是在旋转情况下，很容易出现位姿获取失败，使地下装备自主行走过程中的安全性大大降低。
技术实现要素：
有鉴于此，本发明实施例提供了一种地下环境定位方法、装置、设备及存储介质，旨在提高地下环境中定位的精度，满足地下装备的自主行走的无人驾驶需求。
本发明实施例的技术方案是这样实现的：
本发明实施例提供了一种地下环境定位方法，包括：
获取扫描点云数据的特征点云；
以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；
基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿；
其中，所述特征地图是基于实时的激光里程计及建图(loam，lidarodometryandmappinginreal-time)生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正。
本发明实施例还提供了一种地下环境定位装置，包括：
获取模块，用于获取扫描点云数据的特征点云；
预测模块，用于以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；
位姿确定模块，用于基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿；
其中，所述特征地图是基于loam生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正。
本发明实施例又一种地下环境定位设备，包括：处理器和用于存储能够在处理器上运行的计算机程序的存储器，其中，所述处理器，用于运行计算机程序时，执行本发明任一实施例所述方法的步骤。
本发明实施例还提供了一种存储介质，所述存储介质上存储有计算机程序，所述计算机程序被处理器执行时，实现本发明任一实施例所述方法的步骤。
本发明实施例提供的技术方案，通过基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿，且特征地图是基于loam生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正，实现了基于距离权重的地下环境的精确定位，能够提高地下环境中定位的精度，满足地下装备的自主行走的无人驾驶需求。
附图说明
图1为本发明实施例地下环境定位方法的流程示意图；
图2为本发明实施例中点云坐标系变换的示意图；
图3为本发明一实施例地下环境定位框架的示意图；
图4为本发明实施例地下环境定位装置的结构示意图；
图5为本发明实施例地下环境定位设备的结构示意图。
具体实施方式
下面结合附图及实施例对本发明再作进一步详细的描述。
除非另有定义，本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的，不是旨在于限制本发明。
相关技术中，三维激光雷达(又称为3d激光雷达)的出现，为地下环境的精确定位带来了便利，可以通过采集丰富的3d环境点云信息，实现高精度地图构建及定位的应用。发明人在实现本发明的过程中，发现三维激光雷达的采集点的距离越远，其测量误差越大，采集点距离越近，其测量误差越小。同时由于在地下环境中，其地面并不是十分平整，在三维激光雷达的移动过程中，少许的抖动更会增加远距离数据点(即点云)的测量误差。现有的slam(即时定位与地图构建)系统在建图过程中，一般是给地图划分栅格，根据实时点云数据的不断增加，对栅格内的点值进行不断的加权平均更新，求其均值和方差，很少考虑其测量误差，虽然loam中对运动畸变进行了去畸处理，但是没有考虑测量本身的误差对建图的影响。
基于此，在本发明的各种实施例中，基于loam的地图构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正，实现了基于距离权重的地下环境的精确定位，能够提高地下环境中定位的精度，满足地下装备的自主行走的无人驾驶需求。
本发明实施例提供了一种地下环境定位方法，如图1所示，包括：
步骤101，获取扫描点云数据的特征点云；
步骤102，以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；
步骤103，基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿。
其中，所述特征地图是基于实时的激光里程计及建图(loam)生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正。
本发明实施例中，由于特征地图是基于点云与扫描设备的距离进行修正后生成的，基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿，实现了基于距离权重的地下环境的精确定位，能够提高地下环境中定位的精度，满足地下装备的自主行走的无人驾驶需求。
在一实施例中，扫描设备为三维激光雷达。这里，以vlp-16三维激光雷达为例，vlp-16三维激光雷达是velodyne公司出品的三维激光雷达。其竖直分辨率约为2°，水平分辨率最大为0.4°。把单个线束称为一个scan，对全部16线组成的一帧点云称为一个sweep。一帧内所有的点云，都是按顺序串行扫描的，同一个时间点，只会有一次发送，紧接着一次接收。先从水平第一个角度，一般在0°左右，扫描这个水平角度上竖直方向所有16个点(对应16个scan)的深度，当然这16个点也是串行按顺序的，然后转到下一个水平角度，比如0.3°开始，水平分辨率0.4°，那么下个角度就是0.7°，然后1.1°，一直顺时针扫完一圈，完成一个sweep数据的采集，其输出形式为每个点云对应的(x，y，z，i)，其中，(x，y，z)为三维坐标，i为反射强度值。
这里，地下环境定位设备获取三维激光雷达扫描得到的扫描点云数据，其中，一帧扫描点云数据即三维激光雷达扫描采集的一个sweep数据。
本发明实施例中，地下环境定位设备获取到扫描点云数据后，对扫描点云数据基于无损卡尔曼滤波(ukf，unscentedkalmanfilter)构建特征地图、点云帧与帧匹配、点云帧与地图匹配的定位框架，实现地下环境的准确定位。其中，ukf是无损变换(ut)和标准卡尔曼(kalman)滤波体系的结合，通过无损变换使非线性系统方程适用于线性假设下的标准卡尔曼滤波体系。ukf以ut变换为基础，摒弃了对非线性函数进行线性化的传统做法，采用卡尔曼线性滤波框架，对于一步预测方程，使用ut来处理均值和协方差的非线性传递，就成为ukf算法。ukf是对非线性函数的概率密度分布进行近似，用一系列确定样本来逼近状态的后验概率密度，而不是对非线性函数进行近似，不需要求导计算jacobian(雅克比)矩阵。ukf没有线性化忽略高阶项，因此非线性分布统计量的计算精度较高。
这里，地下环境定位设备对获取的扫描点云数据基于聚类方法进行噪声移除，提取扫描点云数据的特征点云。具体地，可以对噪声移除后的扫描点云数据采用loam中的特征提取方法进行特征提取，得到扫描点云数据的特征点云，比如，提取corner地图和surface地图对应的点云作为特征点云。在其他实施例中，扫描设备可以对扫描获取的扫描点云数据进行特征提取，得到扫描点云数据的特征点云并传送给地下环境定位设备，使得地下环境定位设备获取扫描点云数据的特征点云。
基于ukf的定位框架的地下环境定位包括：预测位姿阶段和修正位姿阶段。其中，预测位姿阶段即前述步骤102，修正位姿阶段即前述步骤103。
这里，可以将上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿。
实际应用中，定义三维激光雷达的位姿状态向量为：
其中，pt为t时刻的三维激光雷达的三维坐标，qt为t时刻的三维激光雷达的四元数。
地下环境定位设备通过在连续帧之间迭代地应用所提取的特征点云确定三维激光雷达的预测位姿。具体地，可以基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧(scantoscan)匹配，得到当前帧与上一帧间的相对位姿；基于所述相对位姿和上一帧的位姿得到当前的预测位姿。
示例性地，可以将实时获取的当前帧的特征点云与上一相邻帧的特征点云进行匹配，来获得重新扫描帧t时刻到最近帧t-1时刻的相对位姿δxt-1,t＝[δpt,δqt]t，同时t-1时刻三维激光雷达在世界坐标中的位姿为xt-1，则t时刻三维激光雷达的预测位姿计算如下：
xt＝xt-1δxt-1,t
在一实施例中，所述基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿，包括：
以所述当前的预测位姿作为点云帧与地图匹配的初始值，对当前帧的扫描点云数据的特征点云与特征地图进行点云帧与地图(scantomap)匹配得到配准位姿，将所述配准位姿作为当前的修正位姿。需要说明的是，在一实施例中，当前的修正位姿可以作为下一帧的初始位姿。若上一帧为第一帧时，则当前的初始位姿可以选取扫描设备的起始位置。
实际应用中，以所述预测位姿xt作为点云帧与地图匹配的初始值，通过点云帧与地图匹配，得到配准位姿为
由于在进行点云帧与地图匹配时，需要用到特征地图。基于此，在一实施例中，所述方法还包括:
基于loam对已获取的扫描点云数据进行地图构建，得到初始的特征地图；
对所述初始的特征地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图。
这里，所述基于loam对已获取的扫描点云数据进行地图构建，得到初始的特征地图，包括：
根据第一频率对已获取的扫描点云数据基于帧间匹配，得到相邻帧的数据间匹配的拼接位姿；
根据第二频率对相邻帧的数据基于相应的拼接位姿拼接，得到初始的角corner地图和初始的面surface地图；
其中，所述第一频率大于所述第二频率。
loam可以使用一个三维空间中运动的两轴激光雷达来获得低漂移和低复杂度，并且不需要高精度的测距和惯性测量的实时激光里程计和地图，其核心思想是将定位和建图的分割，通过两个算法：一个是执行高频率的里程计但是低精度的运动估计(定位)，通过对每一帧激光的配准，可以得到一个精度较差的odom(里程计)，由于没有imu(惯性测量单元)提供帧间匹配的初始位姿，因此对loam进行少许改动，运用一个匀速运动模型来计算帧与帧配准的拼接位姿(pose)；另一个算法在一个数量级低的频率执行匹配和注册点云信息(建图和校正里程计)，通过将多帧的激光特征点云基于拼接位姿拼接，形成特征点云地图(即前述的特征地图)。具体地，可以包括：corner地图和surface地图。这样，就建立了两种特征点云地图。此外，还可以将新入的帧与特征点云地图作配准，得到更精准的拼接位姿，并基于这个更精准的拼接位姿进行拼接，得到更新的特征点云地图；将这两个算法结合就获得了高精度、实时性的激光里程计。
本发明实施例中，还需要对特征点云地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图，包括：
将初始的corner地图和初始的corner地图的三维点云转换至世界坐标系并划分至世界坐标系下的三维栅格中；
针对每个栅格，统计各栅格内点云的个数，并基于各点云与设定位置的距离，对各点云进行权值赋值，确定各栅格对应的坐标；
根据各栅格对应的坐标更新初始的corner地图和corner地图，得到修正后的特征地图。
实际应用中，对特征点云地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图，包括：
步骤1，依据得到的三维激光雷达的位姿信息，把激光雷达坐标系下的三维点云坐标转换到世界坐标系下，如图2所示。设三维激光雷达坐标系下三维点坐标为pl＝(xl,yl,zl)，三维激光雷达位姿信息用旋转矩阵twl表示，则世界坐标系下三维点云坐标pw＝(xw,yw,zw)，满足如下公式：
pw＝twl·pl
在三维激光雷达坐标系下，计算三维点云中任意一点距离三维激光雷达坐标原点的距离
步骤2，把世界坐标下的实时转换点云和局部地图点云划分到三维栅格中。当实时转换的点云为第一帧数据时，初始化点云地图，只需把第一帧转换点云划分到三维栅格中。在后续的三维激光帧中，需把转换点云和局部地图划分到三维栅格中。
针对每一个栅格，统计栅格内点云的个数n，根据激光雷达的测量特性，距离远的点其测量误差相对较大，依据上述点到激光雷达坐标系原点的距离s的计算方法，给每个点赋予相应的权值
根据转换后的三维点坐标和其相应的权重，计算每个栅格中此时刻最终点坐标pwc＝(xwc,ywc,zwc)，其满足如下公式：
根据最终点坐标pwc＝(xwc,ywc,zwc)，计算其在三维激光雷达坐标系下坐标plc＝(xlc,ylc,zlc)，其满足如下公式：
并通过如下公式计算plc与此时刻三维激光雷达坐标原点的距离：
步骤3，依据得到的每一时刻位姿和其三维点云信息，不断迭代以上两个步骤，可以逐步对点云地图进行更新，得到受点云噪声影响小的完整三维点云地图(即修正后的特征地图)。
如图3所示，在一实施例中，三维激光雷达采用velodyne公司的vlp-16，地下环境精确定位框架主要分为基于3d激光雷达的离线距离权重点云地图构建和基于距离权重点云地图的实时精确定位。针对离线地图构建，首先基于loam生成cornern地图和surface地图，同时在生成地图过程中，根据3d激光雷达的数据采集特性，距离远的障碍物返回值较距离近的障碍物返回值偏移距离误差大，采用距离幂次反比法根据每个点的距离赋予不同的权值，进而对生成的特征地图进行修正，得到基于loam和距离幂次反比法的特征地图。针对基于距离权重地图的实时精确定位，为保证后续处理效率及定位精度，首先基于聚类方法进行噪声移除，同时采用loam中的特征提取方法对实时点云进行特征提取，得到特征点云；其次，基于无损卡尔曼滤波实现地下环境的实时定位。其中，在预测位姿阶段，主要通过点云帧间匹配进行位姿估计得到预测位姿；在修正位姿阶段，通过实时点云与构建的距离权重地图进行点云帧与地图，得到当前的修正位姿，最终输出实时精确位姿，同时该修正位姿也用于下一次循环的初始位姿。
实际应用中，将本发明实施例地下环境定位方法应用于在地下多个场景中进行测试，包括表面光滑直巷道、表面光滑回环巷道、粗糙非直巷道及粗糙斜坡道，通过定位误差及定位时间分析证明该算法实现地下环境的精准定位及算法的鲁棒性，并从定位误差、定位时间等方面进行对比分析，定位误差能控制在4cm左右，定位时间平均控制在60ms左右，结果表明该算法可以实现低漂移的实时定位。
为了实现本发明实施例的方法，本发明实施例还提供一种地下环境定位装置，如图4所示，该装置包括：获取模块401、预测模块402、位姿确定模块403。其中，
获取模块401，用于获取扫描点云数据的特征点云；
预测模块402，用于以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；
位姿确定模块403，用于基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿；
其中，所述特征地图是基于loam生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正。
在一实施例中，地下环境定位装置还包括：地图构建模块404，用于：
基于loam对已获取的扫描点云数据进行地图构建，得到初始的特征地图；
对所述初始的特征地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图。
在一实施例中，地图构建模块404具体用于：
根据第一频率对已获取的扫描点云数据基于帧间匹配，得到相邻帧的数据间匹配的拼接位姿；
根据第二频率对相邻帧的数据基于相应的拼接位姿拼接，得到初始的角corner地图和初始的面surface地图；
其中，所述第一频率大于所述第二频率。
在一实施例中，地图构建模块404具体用于：
将初始的corner地图和初始的corner地图的三维点云转换至世界坐标系并划分至世界坐标系下的三维栅格中；
针对每个栅格，统计各栅格内点云的个数，并基于各点云与设定位置的距离，对各点云进行权值赋值，确定各栅格对应的坐标；
根据各栅格对应的坐标更新初始的corner地图和corner地图，得到修正后的特征地图。
在一实施例中，预测模块402具体用于：
基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，得到当前帧与上一帧间的相对位姿；
基于所述相对位姿和上一帧的位姿得到当前的预测位姿。
在一实施例中，位姿确定模块403具体用于：
以所述当前的预测位姿作为点云帧与地图匹配的初始值，对当前帧的扫描点云数据的特征点云与特征地图进行点云帧与地图匹配得到配准位姿，将所述配准位姿作为当前的修正位姿。
实际应用时，获取模块401、预测模块402、位姿确定模块403及地图构建模块404，可以由地下环境定位装置中的处理器来实现。当然，处理器需要运行存储器中的计算机程序来实现它的功能。
需要说明的是：上述实施例提供的地下环境定位装置在进行地下环境定位时，仅以上述各程序模块的划分进行举例说明，实际应用中，可以根据需要而将上述处理分配由不同的程序模块完成，即将装置的内部结构划分成不同的程序模块，以完成以上描述的全部或者部分处理。另外，上述实施例提供的地下环境定位装置与地下环境定位方法实施例属于同一构思，其具体实现过程详见方法实施例，这里不再赘述。
基于上述程序模块的硬件实现，且为了实现本发明实施例的方法，本发明实施例还提供一种地下环境定位设备。图5仅仅示出了该设备的示例性结构而非全部结构，根据需要可以实施图5示出的部分结构或全部结构。
如图5所示，本发明实施例提供的地下环境定位设备500包括：至少一个处理器501、存储器502、用户接口503和至少一个网络接口504。地下环境定位设备500中的各个组件通过总线系统505耦合在一起。可以理解，总线系统505用于实现这些组件之间的连接通信。总线系统505除包括数据总线之外，还包括电源总线、控制总线和状态信号总线。但是为了清楚说明起见，在图5中将各种总线都标为总线系统505。
其中，用户接口503可以包括显示器、键盘、鼠标、轨迹球、点击轮、按键、按钮、触感板或者触摸屏等。
本发明实施例中的存储器502用于存储各种类型的数据以支持地下环境定位设备的操作。这些数据的示例包括：用于在地下环境定位设备上操作的任何计算机程序。
本发明实施例揭示的地下环境定位方法可以应用于处理器501中，或者由处理器501实现。处理器501可能是一种集成电路芯片，具有信号的处理能力。在实现过程中，地下环境定位方法的各步骤可以通过处理器501中的硬件的集成逻辑电路或者软件形式的指令完成。上述的处理器501可以是通用处理器、数字信号处理器(dsp，digitalsignalprocessor)，或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。处理器501可以实现或者执行本发明实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者任何常规的处理器等。结合本发明实施例所公开的方法的步骤，可以直接体现为硬件译码处理器执行完成，或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于存储介质中，该存储介质位于存储器502，处理器501读取存储器502中的信息，结合其硬件完成本发明实施例提供的地下环境定位方法的步骤。
在示例性实施例中，地下环境定位设备可以被一个或多个应用专用集成电路(asic，applicationspecificintegratedcircuit)、dsp、可编程逻辑器件(pld，programmablelogicdevice)、复杂可编程逻辑器件(cpld，complexprogrammablelogicdevice)、fpga、通用处理器、控制器、微控制器(mcu，microcontrollerunit)、微处理器(microprocessor)、或者其他电子元件实现，用于执行前述方法。
在一应用示例中，地下环境定位设备包括16线3d激光雷达、移动电源及笔记本电脑，该移动电源供电给16线3d激光雷达和笔记本电脑，笔记本电脑与16线3d激光雷达通信连接，笔记本电脑运行计算机程序时，实现前述任一实施例所述的地下环境定位方法。
可以理解，存储器502可以是易失性存储器或非易失性存储器，也可包括易失性和非易失性存储器两者。其中，非易失性存储器可以是只读存储器(rom，readonlymemory)、可编程只读存储器(prom，programmableread-onlymemory)、可擦除可编程只读存储器(eprom，erasableprogrammableread-onlymemory)、电可擦除可编程只读存储器(eeprom，electricallyerasableprogrammableread-onlymemory)、磁性随机存取存储器(fram，ferromagneticrandomaccessmemory)、快闪存储器(flashmemory)、磁表面存储器、光盘、或只读光盘(cd-rom，compactdiscread-onlymemory)；磁表面存储器可以是磁盘存储器或磁带存储器。易失性存储器可以是随机存取存储器(ram，randomaccessmemory)，其用作外部高速缓存。通过示例性但不是限制性说明，许多形式的ram可用，例如静态随机存取存储器(sram，staticrandomaccessmemory)、同步静态随机存取存储器(ssram，synchronousstaticrandomaccessmemory)、动态随机存取存储器(dram，dynamicrandomaccessmemory)、同步动态随机存取存储器(sdram，synchronousdynamicrandomaccessmemory)、双倍数据速率同步动态随机存取存储器(ddrsdram，doubledataratesynchronousdynamicrandomaccessmemory)、增强型同步动态随机存取存储器(esdram，enhancedsynchronousdynamicrandomaccessmemory)、同步连接动态随机存取存储器(sldram，synclinkdynamicrandomaccessmemory)、直接内存总线随机存取存储器(drram，directrambusrandomaccessmemory)。本发明实施例描述的存储器旨在包括但不限于这些和任意其它适合类型的存储器。
在示例性实施例中，本发明实施例还提供了一种存储介质，即计算机存储介质，具体可以是计算机可读存储介质，例如包括存储计算机程序的存储器502，上述计算机程序可由地下环境定位设备的处理器501执行，以完成本发明实施例方法所述的步骤。计算机可读存储介质可以是rom、prom、eprom、eeprom、flashmemory、磁表面存储器、光盘、或cd-rom等存储器。
需要说明的是：“第一”、“第二”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。
另外，本发明实施例所记载的技术方案之间，在不冲突的情况下，可以任意组合。
以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以权利要求的保护范围为准。
技术特征：
1.一种地下环境定位方法，其特征在于，包括：
获取扫描点云数据的特征点云；
以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；
基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿；
其中，所述特征地图是基于实时的激光里程计及建图loam生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正。
2.根据权利要求1所述的方法，其特征在于，还包括：
基于loam对已获取的扫描点云数据进行地图构建，得到初始的特征地图；
对所述初始的特征地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图。
3.根据权利要求2所述的方法，其特征在于，所述基于loam对已获取的扫描点云数据进行地图构建，得到初始的特征地图，包括：
根据第一频率对已获取的扫描点云数据基于帧间匹配，得到相邻帧的数据间匹配的拼接位姿；
根据第二频率对相邻帧的数据基于相应的拼接位姿拼接，得到初始的角corner地图和初始的面surface地图；
其中，所述第一频率大于所述第二频率。
4.根据权利要求3所述的方法，其特征在于，所述对所述初始的特征地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图，包括：
将初始的corner地图和初始的corner地图的三维点云转换至世界坐标系并划分至世界坐标系下的三维栅格中；
针对每个栅格，统计各栅格内点云的个数，并基于各点云与设定位置的距离，对各点云进行权值赋值，确定各栅格对应的坐标；
根据各栅格对应的坐标更新初始的corner地图和corner地图，得到修正后的特征地图。
5.根据权利要求1所述的方法，其特征在于，所述基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿，包括：
基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，得到当前帧与上一帧间的相对位姿；
基于所述相对位姿和所述当前的初始位姿得到当前的预测位姿。
6.根据权利要求1所述的方法，其特征在于，所述基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿，包括：
以所述当前的预测位姿作为点云帧与地图匹配的初始值，对当前帧的扫描点云数据的特征点云与特征地图进行点云帧与地图匹配得到配准位姿，将所述配准位姿作为当前的修正位姿。
7.一种地下环境定位装置，其特征在于，包括：
获取模块，用于获取扫描点云数据的特征点云；
预测模块，用于以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；
位姿确定模块，用于基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿；
其中，所述特征地图是基于loam生成的，且所述特征地图的构建过程中，基于点云与扫描设备间的距离对扫描点云数据进行修正。
8.根据权利要求7所述的装置，其特征在于，还包括：地图构建模块，用于：
基于loam对已获取的扫描点云数据进行地图构建，得到初始的特征地图；
对所述初始的特征地图基于距离幂次反比法对特征点的距离赋予权值，得到修正后的特征地图。
9.一种地下环境定位设备，其特征在于，包括：处理器和用于存储能够在处理器上运行的计算机程序的存储器，其中，
所述处理器，用于运行计算机程序时，执行权利要求1至6任一项所述方法的步骤。
10.一种存储介质，所述存储介质上存储有计算机程序，其特征在于，所述计算机程序被处理器执行时，实现权利要求1至6任一项所述方法的步骤。
技术总结
本发明公开了一种地下环境定位方法、装置、设备及存储介质。其中，该方法包括：获取扫描点云数据的特征点云；以上一帧的位姿作为当前的初始位姿，基于当前帧的扫描点云数据的特征点云与上一帧的扫描点云数据的特征点云进行点云帧与帧匹配，确定当前的预测位姿；基于当前帧的扫描点云数据的特征点云、所述当前的预测位姿和特征地图，进行点云帧与地图匹配，得到当前的修正位姿。本发明实施例实现了基于距离权重的地下环境的精确定位，能够提高地下环境中定位的精度，满足地下装备的自主行走的无人驾驶需求。
技术研发人员：王李管;任助理;毕林;段长铭
受保护的技术使用者：中南大学
技术研发日：.12.03
技术公布日：.02.28
