【技术实现步骤摘要】
本专利技术涉及智能服务机器人的导航，特别是一种基于单线激光雷达点云配准的底盘充电回桩方法。
技术介绍
1、智能机器人行业，特别是自主移动机器人的底盘回桩充电技术，正在迅速发展。首先，底盘回桩充电技术需要解决的一个重要问题是定位精度。由于充电桩的位置可能会发生变化，或者在复杂的环境中难以识别，因此机器人需要具备较高的定位精度才能准确地找到充电桩并进行充电。其次，底盘回桩充电技术还需要解决路径规划问题。在实际应用中，机器人可能需要在复杂的道路环境中进行路径规划，以避免碰撞和堵塞。此外，底盘回桩充电技术还需要考虑到机器人的安全性和可靠性。在实际应用中，机器人可能会遇到各种异常情况，如充电桩故障、电力供应中断等。为了保证机器人的安全和可靠运行，底盘回桩充电方案需要具备一定的容错能力和故障处理能力底盘回桩充电技术是智能机器人行业的一个重要研究方向。
技术实现思路
1、有鉴于此，本专利技术的目的在于提供一种基于单线激光雷达点云配准的底盘充电回桩方法，基于点云配准，结合聚类，pca，计算点云最小包围框等思想筛选出充电桩点云，能够准确地找到充电桩并进行回桩充电。
2、为实现上述目的，本专利技术采用如下技术方案：一种基于单线激光雷达点云配准的底盘充电回桩方法，包括以下步骤：
3、步骤一：数据采集及预处理：使用单线激光雷达采集场景点云数据，对点云进行统计学滤波消除噪声点；
4、步骤二：dbscan聚类：对预处理后的点云进行欧式聚类，便于筛选点云簇；
5、
6、步骤四：计算最小包围框：对符合方差分布的点云簇计算其最小包围框，通过包围框尺寸筛选点云簇；
7、步骤五：点云匹配：使用迭代最近点算法icp计算目标点云簇与符合包围框尺寸的点云簇的得分，筛选出最符合的点云簇；
8、步骤六：计算出变换矩阵：利用在底盘中心的目标点云簇与最符合的点云簇之间的匹配关系，计算出变换矩阵；
9、步骤七：规划底盘回桩行进路线：根据计算出的初始变换矩阵，规划出底盘回桩三步走回桩路线。
10、在一较佳的实施例中，所述步骤一中，单线激光雷达数据采集的过程包括以下几个步骤：首先，激光雷达会发射激光束，这些激光束会照射到周围的物体上并反射回来；当激光束碰到物体时，它们会反弹回雷达，并被雷达接收器捕获；此时，雷达的接收器会记录下每个反射点的时间戳和位置信息；然后，这些收集到的数据会被传送到雷达设备的内部处理器进行处理；处理过程中，雷达设备会对激光反射点的强度信息与目标物表面材质与粗糙度、激光入射角度、激光波长以及激光雷达的能量密度等因素进行关联分析；接着，基于上述分析结果和已知的激光雷达参数，设备会对这些反射点进行滤波和去噪处理，以消除由于各种因素产生的噪声点，得到更为清晰和准确的数据；
11、采用移动平均法去除数据的噪声；然后将这个平均值用于代表当前时间点的数据；这个平均值的计算窗口固定大小，较小的窗口用于平滑数据中的高频噪音，而较大的窗口用于捕捉数据中的长期趋势；
12、
13、其中，ma(t)是在时间点t处的移动平均值，x(t-i)是前n个时间点的数据值，n是滑动窗口的大小；通常，n的选择取决于数据的性质和所需的平滑效果。
14、在一较佳的实施例中，所述步骤二中，使用dbscan聚类对雷达采集的点云数据分成不同的簇或群组，以便于筛选出检测到的充电桩点云簇,流程如下：
15、1)初始化：设定两个参数，邻域半径ε和最小邻居数minpts；
16、2)随机选择一个未访问的数据点p；
17、3)检查p的ε邻域内是否有至少minpts个数据点，如果有，则创建一个新簇，并将p标记为已访问；
18、4)以p为中心，找到其ε邻域内的所有未访问数据点，将它们添加到当前簇中，并标记为已访问；
19、5)重复步骤4直到当前簇无法再扩展；
20、6)如果当前簇中的数据点数量大于等于minpts，则将该簇保留，否则将其舍弃；
21、7)重复步骤2-6直到所有数据点都被访问；
22、8)结束，得到所有点云簇的集合。
23、在一较佳的实施例中，所述步骤三中主成分分析的详细步骤如下：
24、1)数据标准化：对原始数据进行标准化处理，使得每个特征具有零均值和单位方差，以避免不同尺度之间的影响；
25、2)计算协方差矩阵：基于标准化后的数据，计算协方差矩阵；协方差矩阵反映了不同特征之间的相关性；
26、3)特征值分解：对协方差矩阵进行特征值分解，得到特征值和对应的特征向量；特征值表示各个特征向量所代表的主成分的重要程度和方差大小，特征向量则表示各个主成分的方向；
27、4)选择主成分：根据特征值的大小，选择前k个特征值对应的特征向量作为主成分；通常选择的特征值足够大，能够解释大部分的方差；
28、对每个点云簇进行主成分分析，首先对数据进行标准化处理，根据标准化处理后的数据计算协方差矩阵，对协方差矩阵进行特征值分解，得到特征值与对应的特征向量，特征值表示每个特征向量所代表的主成分的重要程度和方差大小，特征向量则表示主成分的方向，根据特征值的大小，选择最大的特征值及其对应的特征向量作为x轴，其次大的特征值及其对应的特征向量作为y轴；这些主成分将用于构建新的坐标系；根据两个特征值的大小与目标点云也就是充电桩模板主成分分析之后获得的特征值进行比较，差异大的即排除是充电桩点云的可能，差异在一定范围内的即进入下个判断。
29、在一较佳的实施例中，所述步骤四具体包括：根据步骤三获取到的点云簇转换到新坐标系，通过pca分析获得的投影矩阵w将原始二维点云簇投影到新的坐标系中；然后计算边界框坐标，在新坐标系中，找到点云簇在x和y轴上的最小和最大值，这将定义一个包含点云簇的边界框；最后定义最小包围框：使用最小和最大值确定的边界框的四个顶点，包括左下、左上、右上和右下，以及它们之间的连线，定义点云簇的最小包围框；
30、最小包围框的计算过程示例如下：
31、假设在新坐标系下，点云簇的投影结果为p＝[p1,p2,...,pn]，其中每个元素pi＝(x,y)是一个二维点；
32、计算x轴的最小和最大值：min_x＝min(pi.x)，max_x＝max(pi.x)
33、计算y轴的最小和最大值：min_y＝min(pi.y)，max_y＝max(pi.y)
34、定义最小包围框的四个顶点：
35、左下角坐标：(min_x,min_y)
36、左上角坐标：(min_x,max_y)
37、右上角坐标：(max_x,max_y)
38、右下角坐标：(max_x,min_y)
39、通过这些顶本文档来自技高网...
【技术保护点】
1.一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于包括以下步骤：
2.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤一中，单线激光雷达数据采集的过程包括以下几个步骤：首先，激光雷达会发射激光束，这些激光束会照射到周围的物体上并反射回来；当激光束碰到物体时，它们会反弹回雷达，并被雷达接收器捕获；此时，雷达的接收器会记录下每个反射点的时间戳和位置信息；然后，这些收集到的数据会被传送到雷达设备的内部处理器进行处理；处理过程中，雷达设备会对激光反射点的强度信息与目标物表面材质与粗糙度、激光入射角度、激光波长以及激光雷达的能量密度等因素进行关联分析；接着，基于上述分析结果和已知的激光雷达参数，设备会对这些反射点进行滤波和去噪处理，以消除由于各种因素产生的噪声点，得到更为清晰和准确的数据；
3.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤二中，使用DBSCAN聚类对雷达采集的点云数据分成不同的簇或群组，以便于筛选出检测到的充电桩点云簇，流程如下：
4.根据权利
5.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤四具体包括：根据步骤三获取到的点云簇转换到新坐标系，通过PCA分析获得的投影矩阵W将原始二维点云簇投影到新的坐标系中；然后计算边界框坐标，在新坐标系中，找到点云簇在x和y轴上的最小和最大值，这将定义一个包含点云簇的边界框；最后定义最小包围框：使用最小和最大值确定的边界框的四个顶点，包括左下、左上、右上和右下，以及它们之间的连线，定义点云簇的最小包围框；
6.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤五具体包括：将符合步骤四的所有点云与目标点云进行配准，若有多个点云即选择与目标点云最接近的，否则即计算该点云与目标点云的配准得分；配准得分低于设定的阈值S，即检测到充电桩，否则未检测到充电桩；具体的点云匹配流程如下：
7.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤六具体包括：首先从符合步骤五中的点云与目标点云提取特征点，以获取局部结构信息；然后对两个点云的特征点进行匹配，通过比较特征点之间的距离或相似性度量来确定匹配关系；接着根据匹配的特征点对齐两个点云的初始位置；通过最小二乘或随机采样一致算法估计初始变换矩阵；然后通过迭代优化算法，进一步优化初始对齐的变换矩阵；最后收敛判断：在迭代优化过程中，通过设定收敛条件来判断是否达到最优结果；如果没有达到，则返回第4步继续迭代，直到满足收敛条件；
8.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤七具体包括：根据步骤六计算出来的变换矩阵，即计算出底盘导航至导航点区域相对于充电桩的位姿态，根据变换矩阵计算出底盘回桩三步走的具体路线，计算方式如下：
...【技术特征摘要】
1.一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于包括以下步骤：
2.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤一中，单线激光雷达数据采集的过程包括以下几个步骤：首先，激光雷达会发射激光束，这些激光束会照射到周围的物体上并反射回来；当激光束碰到物体时，它们会反弹回雷达，并被雷达接收器捕获；此时，雷达的接收器会记录下每个反射点的时间戳和位置信息；然后，这些收集到的数据会被传送到雷达设备的内部处理器进行处理；处理过程中，雷达设备会对激光反射点的强度信息与目标物表面材质与粗糙度、激光入射角度、激光波长以及激光雷达的能量密度等因素进行关联分析；接着，基于上述分析结果和已知的激光雷达参数，设备会对这些反射点进行滤波和去噪处理，以消除由于各种因素产生的噪声点，得到更为清晰和准确的数据；
3.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤二中，使用dbscan聚类对雷达采集的点云数据分成不同的簇或群组，以便于筛选出检测到的充电桩点云簇，流程如下：
4.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤三中主成分分析的详细步骤如下：
5.根据权利要求1所述的一种基于单线激光雷达点云配准的底盘充电回桩方法，其特征在于，所述步骤四具体包括：根据步骤三获取到的点云簇转换到新坐标系，通过pca分析获得的投影矩阵w将原始二维点云簇投影到新的坐标系中；然后计算边界...
【专利技术属性】
技术研发人员：张卫波，陈虎，王单坤，林景胜，丘英浩，
申请(专利权)人：福州大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。