[发明专利]一种室内未知环境下使用激光雷达定位方法

说明书

技术领域

本发明属于定位技术领域，特别是一种室内未知环境下使用激光雷达定位方法。

背景技术

以往的定位系统主要解决的问题是在户外如何实时地实现载体的精确定位，但对于室内环境应用而言，这样的定位系统不能满足实时定位的精确性要求。GPS定位因为在室内容易受到信号干扰以及接收不到卫星信号而无法精确定位；地磁定位因为容易受到地磁干扰而无法精确定位；惯导系统定位因为随着时间发散而影响到定位精度；视觉导航定位系统受环境光照等影响剧烈，定位精度低，且定位可靠性差。因此，当载体在室内未知环境下运动时，实现对其实时、精确的定位成为当前定位系统发展的一个趋势。

发明内容

本发明要解决的技术问题是提供一种激光雷达定位方法，该方法可以排除室内环境对传统定位技术的限制，实现室内未知环境下的实时精确定位。

本发明公开的一种室内未知环境下使用激光雷达定位方法，包括以下步骤：

1)将激光雷达置于待定位的物体上；建立特征提取模型，提取室内环境下激光雷达扫描点里的线段和角点特征，并构建二维局部地图；

2)在所述步骤1)特征提取模型的基础上，以第一帧能够在局部坐标系下第二象限检测到直角的扫描点构建的地图作为全局地图，之后每一帧扫描点构建的局部地图与前一帧局部地图进行混合特征匹配，当发现新的线段特征和角点特征，就将特征加入到全局地图中，实现全局地图的实时更新；

3)在所述步骤2)的基础上，建立当前局部坐标系与全局坐标系的坐标转换关系，判断特征的空间变化，实现激光雷达的自定位，得到定位参数(T_x,T_y,θ)，(T_x,T_y)表示为载有激光雷达的载体在室内的位置，θ表示为载有激光雷达的载体在室内的相对偏移角度。

作为上述技术方案的进一步改进，步骤1)中所述的提取室内环境下激光雷达扫描点里的线段和角点特征的过程为：

11)设置自适应阈值γ＝λδ，λ为自适应因数，δ为激光雷达测量单位距离时的阈值；对激光雷达扫描点进行区域分块，去除跳变点；

12)进行线段分割，采用迭代的方式找出每个区域里离第一个点与最后一个点形成的线段距离最远的点，设置一个自适应阈值β，如果一个点到该线段的距离大于β，则为角点，得到角点位置信息(x,y)；

13)对线段分割得到的相邻角点之间的扫描点进行最小二乘法直线拟合，获得线段参数(a,b,rho,x_s,y_s,x_e,y_e)，其中，(a,b)为线段拟合参数；rho为线段所在的直线的斜率；(x_s,y_s),(x_e,y_e)为线段的起始点和终止点坐标。

作为上述技术方案的更进一步改进，步骤2)中所述的混合特征匹配的过程为：

21)以初始时刻构建的地图作为全局地图，构建t_c-1时刻与t_c时刻的局部地图，分别获得地图中的特征参数，包括线段参数和角点参数其中，i＝1,2,…,m,，m为地图的线段个数，j＝1,2,…k，k为地图的角点个数；

22)对t_c-1时刻与t_c时刻局部地图进行线段特征匹配；设定线段匹配判定条件：

条件1：判断线段在全局坐标系下与x轴的夹角：因为rho为线段斜率，可得到线段在局部坐标系下与x轴的夹角β_i

β_i＝arctan(rho_i)(1)

利用上一时刻t_c-1的定位参数推算t_c时刻激光雷达的转角，推算公式为：

然后获得线段在全局坐标系下与x轴的夹角β_gi：

θ_e为t_c时刻航向预估误差角；

设置阈值δ进行线段匹配，如果则认为该线段匹配；如果则判断第i+1条线段斜率，直到所有线段都判断结束，寻找出多余的线段为新增线段；

条件2：从激光雷达坐标系原点作线段的法线ρ，获得法线与线段的交点其中，i＝1,2,…,m,，m为地图的线段个数：

a_i，b_i分别表示第i条线段的线性拟合参数；