专利汇可以提供一种基于扫描线段重合长度估计的激光雷达定位方法专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种基于扫描线段重合长度估计的 激光雷达 定位 方法,首先对单线激光雷达扫描的原始数据进行坐标变换与空间滤波;然后进行扫描数据聚类处理、线段识别,构建局部2D环境地图;接着构建完整线段集,利用完整线段的长度作为匹配的参数,选择最长完整线段与已知的2D环境地图进行完整线段匹 配对 计算;最后进行激光雷达 位姿 估算、不同匹配对所对应扫描线段的重合长度计算,确定位姿。本发明通过计算匹配的完整线段的重合线段的长度来进行定位准确度的评价,解决了完整线段缺失时定位不准确的问题,具有适应性好、定位 精度 高、鲁棒性高等优势。,下面是一种基于扫描线段重合长度估计的激光雷达定位方法专利的具体信息内容。
1.一种基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,具体包括如下步骤:
步骤1、对单线激光雷达扫描的原始数据进行坐标变换与空间滤波;
步骤2、进行扫描数据聚类处理、线段识别,构建局部2D环境地图;
步骤3、构建完整线段集,利用完整线段的长度作为匹配的参数,选择最长完整线段与已知的2D环境地图进行完整线段匹配对计算;
步骤4、进行激光雷达位姿估算、不同匹配对所对应扫描线段的重合长度计算,确定位姿。
2.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤1中,对激光雷达获取的局部原始数据进行坐标转换,将其极坐标转换为直角坐标,具体是以激光雷达发射中心为坐标原点,其运动方向为y轴正方向,y轴开始顺时针旋转90°为x轴正方向建立激光雷达的局部直角坐标系,设激光雷达的某一扫描点为点P,将点P的极坐标(r,θ)转换成直角坐标(xp,yp),如下式所示:
xp=rcosθ
yp=rsinθ。
3.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤1中,空间滤波采用改进的空间均值滤波法对边缘数据的平滑效果进行改进,首先需要确定边缘点,将某一点的距离值与相邻的左右两点的距离值进行比较,如果它们之间差值的绝对值大于设定的阈值,说明该点为边缘点,然后对非边缘点进行空间均值滤波。
4.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤2中,扫描数据聚类处理采用基于自适应阈值的快速近邻聚类法对点云数据进行区域分割,具体方法为:将第一点作为第一个物体的初始边界点,作为第一类,隔点进行比较,若两点间的距离小于阈值2TD,则认为该点与前一点属于同一类,将该点添加至当前类中;
若两点间的距离大于阈值2TD,则认为该点不属于当前类,则开始新的一个类,并以该点作为新的一个类的起点,但此时还需要判断中间点与前一点间的距离是否小于另一个阈值TD,若小于TD,则中间点归为上一类,反之,则认为与下一点为一类,重复上述比较,其中TD为自适应阈值,采用如下的方式进行计算:
TD=αΔr
其中Δr表示相邻两点间的距离,Δr=rsinΔθ,r为雷达获取的极坐标半径,Δθ为激光雷达的角分辨率。
5.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤2中,线段识别采用改进的IEPF来进行线段分割,具体过程为:将同区域内的数据点集中的起点和终点连成一条线段,计算点集中的每一个点到这条线段的距离,找出距离最大的点,如果该距离大于设置的阈值,则以该点为分界点,将原始点集分割成两个新的点集,对两个新的点集重复进行上述过程,直至所有的点到线段的距离都不大于设定的阈值时,结束分割,最后采用RANSAC对分割后的点云数据进行直线拟合。
6.根据权利要求5所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,线段识别中,会出现过分割与欠分割问题,针对欠分割,将阈值设置的尽量小一些,以保证充分分割,尽量排除欠缺分割的情况,这里阈值一般取[0.05,0.15],针对过分割的情况,在进行直线拟合后判断相邻线段间的夹角是否大于某一阈值角度,来确定相邻线段是否属于同一条线段,这里阈值角度一般取[170°,179°]。
7.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤3中,构建完整线段集时,完整线段的具体判定条件如下:1)对于激光雷达获取的局部地图的某一线段,将它向其自身两端各延伸一个虚拟点,若该两虚拟延伸点到激光雷达原点的距离均比实际已知的小,则该线段必为完整线段;2)两个端点各自与两条不同的线段相连接的线段必是完整线段。
8.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤3中,完整线段匹配对计算利用完整线段的长度作为匹配的参数,选择长度最长的完整线段在全局地图中搜索可能与之匹配的完整线段,如果两条完整线段的长度差值在一个阈值范围内,那么则认为这两条完整线段是一对可能的匹配对。
9.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤4中,激光雷达位姿估算根据每对可能的匹配对通过坐标变换分别估算出激光雷达此时的位姿,具体坐标转换公式如下:设激光雷达某个时刻所处的位置在全局直角坐标系中的位姿为R=[xr,yr,α]T,则某一点的局部坐标(xC,yC)和其全局坐标(xG,yG)的关系由下式表示:
两条对应的完整线段的端点之间的对应有两种情况:1)局部地图中完整线段的起点与终点分别与全局地图中完整线段的起点和终点依次对应;2)局部地图中完整线段的起点与全局地图中完整线段的终点对应,局部地图中完整线段的终点与全局地图中完整线段的起点对应;
因此,第一种情况下根据上式可以得到关系式:
第二种情况下根据上式可以得到关系式:
为了得到激光雷达的位姿旋转角α,假设匹配后的线段L与局部坐标x轴的夹角为θL,与全局坐标X轴的夹角为θG,那么可以求得α,如下式所示:
α=θG-θL。
10.根据权利要求1所述的基于扫描线段重合长度估计的激光雷达定位方法,其特征在于,步骤4中,不同匹配对所对应扫描线段的重合长度计算时,首先从不同匹配对中判定重合线段,判定条件为:局部地图的线段两个端点均在全局地图的对应匹配线段上,计算重合线段的重合部分的长度,最后叠加除了匹配对的线段外所有重合线段的重合部分的长度,选择重合长度最长时对应的匹配对为最佳匹配对,此时估算的激光雷达位姿即为当前激光雷达在室内环境地图中所处位姿。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
电介质状态分析方法、系统、计算机及存储介质 | 2020-05-08 | 596 |
目标对象的验证方法及系统、存储介质、电子装置 | 2020-05-08 | 1022 |
虚拟现实头戴设备支架 | 2020-05-08 | 1017 |
内存操作系统制作方法、装置、电子设备和存储介质 | 2020-05-08 | 949 |
一种VNF实例化方法、装置、设备及存储介质 | 2020-05-08 | 745 |
一种基于虚拟指令的冲压装置和方法 | 2020-05-08 | 856 |
一种用于舞台的虚拟角色控制方法 | 2020-05-08 | 914 |
一种无胶吸附式亮面保护膜 | 2020-05-11 | 755 |
一种中药材档案管理柜 | 2020-05-11 | 932 |
治療上の器官冷却 | 2020-05-11 | 455 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。