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

摘要

本发明公开了一种室内未知环境下使用激光雷达定位方法，在传统激光雷达定位基础上，完成室内未知环境下的地图构建，并在构建地图的基础上进行线段和角点的特征匹配，提出一种混合特征匹配滤波模型，实现室内未知环境下的实时精确定位。该方法简单易行，避免室内环境对定位过程的不利影响，适合工程实用。

主权项

一种室内未知环境下使用激光雷达定位方法，其特征在于：包括以下步骤：1)将激光雷达置于待定位的物体上；建立特征提取模型，提取室内环境下激光雷达扫描点里的线段和角点特征，并构建二维局部地图；步骤1)中所述的提取室内环境下激光雷达扫描点里的线段和角点特征的过程为：11)设置自适应阈值γ＝λδ，λ为自适应因数，δ为激光雷达测量单位距离时的阈值；对激光雷达扫描点进行区域分块，去除跳变点；12)进行线段分割，采用迭代的方式找出每个区域里离第一个点与最后一个点形成的线段距离最远的点，设置一个自适应阈值β，如果一个点到该线段的距离大于β，则为角点，得到角点位置信息(x,y)；13)对线段分割得到的相邻角点之间的扫描点进行最小二乘法直线拟合，获得线段参数(a,b,rho,xs,ys,xe,ye)，其中，(a,b)为线段拟合参数；rho为线段所在的直线的斜率；(xs,ys),(xe,ye)为线段的起始点和终止点坐标；2)在所述步骤1)特征提取模型的基础上，以第一帧能够在局部坐标系下第二象限检测到直角的扫描点构建的地图作为全局地图，之后每一帧扫描点构建的局部地图与前一帧局部地图进行混合特征匹配，当发现新的线段特征和角点特征，就将特征加入到全局地图中，实现全局地图的实时更新；步骤2)中所述的混合特征匹配的过程为：21)以初始时刻构建的地图作为全局地图，构建tc‑1时刻与tc时刻的局部地图，分别获得地图中的特征参数，包括线段参数和角点参数其中，i＝1,2,…,m,m为地图的线段个数，j＝1,2,…k，k为地图的角点个数；22)对tc‑1时刻与tc时刻局部地图进行线段特征匹配；设定线段匹配判定条件：条件1：判断线段在全局坐标系下与x轴的夹角：因为rho为线段所在的直线的斜率，可得到线段在局部坐标系下与x轴的夹角βiβi＝arctan(rhoi)   (1)利用上一时刻tc‑1的定位参数推算tc时刻激光雷达的转角，推算公式为：然后获得线段在全局坐标系下与x轴的夹角βgi：θe为tc时刻航向预估误差角；设置阈值δ进行线段匹配，如果则认为该线段匹配；如果则判断第i+1条线段斜率，直到所有线段都判断结束，寻找出多余的线段为新增线段；条件2：从激光雷达坐标系原点作线段的法线ρ，获得法线与线段的交点其中，i＝1,2,…,m,m为地图的线段个数：ai，bi分别表示第i条线段的线性拟合参数；利用上一时刻tc‑1的定位参数推算这一时刻tc的定位参数，再进行局部坐标系到全局坐标系的转换，得到当前时刻法线与线段的交点在全局坐标系位置θe为tc时刻航向预估误差角；为tc时刻x,y方向位置预估误差量；为tc‑1时激光雷达的旋转角度；设定阈值λp比较和两点之间的距离Lp若Lp＜λp，则认为该条线段匹配，即为上一时刻第i条直线；若Lp＞λp，则再比较第i+1条，直到所有直线匹配完毕，多余的线段为新增线段，将其加入全局地图中，实现全局地图的实时更新；当线段匹配同时满足条件1和条件2时，则认为该线段匹配；23)对tc‑1时刻与tc时刻局部地图进行角点特征匹配，判定tc‑1时刻与tc时刻的角点匹配关系，设定阈值λj，比较和两点之间的距离Lj若Lj＜λj，则认为该角点匹配，即为上一时刻的第j个角点；若Lj＞λj，则再比较第j+1个，直到所有角点匹配完毕，多余的角点即为新增角点，将其加入到全局地图中，实现全局地图的实时更新；3)在所述步骤2)的基础上，建立当前局部坐标系与全局坐标系的坐标转换关系，判断特征的空间变化，实现激光雷达的自定位，得到定位参数(Tx,Ty,θ)，(Tx,Ty)表示为载有激光雷达的载体在室内的位置，θ表示为载有激光雷达的载体在室内的相对偏移角度。