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

权利要求书

1.一种室内未知环境下使用激光雷达定位方法，其特征在于：包括以下步骤：

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

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

步骤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条线段的线性拟合参数；

利用上一时刻t_c-1的定位参数推算这一时刻t_c的定位参数，再进行局部坐标系到全局坐标系的转换，得到当前时刻法线与线段的交点在全局坐标系位置

θ_e为t_c时刻航向预估误差角；为t_c时刻x,y方向位置预估误差量；为t_c-1时激光雷达的旋转角度；

设定阈值λ_p比较和两点之间的距离L_p

若L_p＜λ_p，则认为该条线段匹配，即为上一时刻第i条直线；若L_p＞λ_p，则再比较第i+1条，直到所有直线匹配完毕，多余的线段为新增线段，将其加入全局地图中，实现全局地图的实时更新；

当线段匹配同时满足条件1和条件2时，则认为该线段匹配；

23)对t_c-1时刻与t_c时刻局部地图进行角点特征匹配，判定t_c-1时刻与t_c时刻的角点匹配关系，设定阈值λ_j，比较和两点之间的距离L_j

若L_j＜λ_j，则认为该角点匹配，即为上一时刻的第j个角点；若L_j＞λ_j，则再比较第j+1个，直到所有角点匹配完毕，多余的角点即为新增角点，将其加入到全局地图中，实现全局地图的实时更新；

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

2.根据权利要求1所述的一种室内未知环境下使用激光雷达定位方法，其特征在于：步骤3)所述的激光雷达自定位过程如下：

在载体初始位置时，即激光雷达第一帧扫描点，构建全局坐标系，此刻获得的激光雷达的位置和角度都为初始值此时测量的线段参数，角点参数都作为全局坐标系下的线段、角点参数，在载体运动过程中，实时地将采集到的新的特征加入到全局地图中，实现全局地图的实时更新，在进行全局地图更新的同时实现激光雷达自定位；t_c时刻激光雷达测得的局部地图建立局部坐标系，在线段匹配过程中，当t_c时刻激光雷达局部坐标系下线段l_i匹配全局坐标系下的线段l_gi，即可计算得出激光雷达在t_c-1时刻的旋转角度

在角点匹配过程中，当t_c时刻激光雷达局部坐标系下角点(x_j,y_j)匹配全局坐标系下的角点(x_j,y_j)_g

得到激光雷达定位参数(T_x,T_y,θ)，该定位参数即为待定位载体的定位参数，并实时地绘出载体的运动轨迹。