一种基于强化学习的移动机器人路径跟踪方法与流程

文档序号:28743485发布日期:2022-02-07 22:50阅读:200来源:国知局

1.本发明涉及机器人路径跟踪技术领域,具体为一种基于强化学习的移动机器人路径跟踪方法。


背景技术:

2.城市排水系统是处理和排除城市污水和雨水的工程设施系统,是城市公用设施的组成部分。城市排水系统规划是城市总体规划的组成部分。城市排水系统通常由排水管道和污水处理厂组成。在实行污水、雨水分流制的情况下,污水由排水管道收集,送至污水处理后,排入水体或回收利用;雨水径流由排水管道收集后,就近排入水体。
3.由于城市排水系统的排水通道在长期使用后需要进行清理,因此需要为进行清理机器人提供清理路径,由于排水通道在安装后的轴线并不一定与理论中的一样,因此直接使用会导致清理机器人无法按照预定的路径进行清理。


技术实现要素:

4.(一)解决的技术问题
5.针对现有技术的不足,本发明提供了一种基于强化学习的移动机器人路径跟踪方法,解决了清理机器人在进行清理时需要提供追踪路径的问题。
6.(二)技术方案
7.为实现以上目的,本发明通过以下技术方案予以实现:一种基于强化学习的移动机器人路径跟踪方法,包括以下步骤:
8.步骤一:对前进方向进行断面扫描
9.确定移动机器人在排水通道内的前进方向,并使用移动机器人上安装的断面扫描仪对排水通道的内壁按照前进1mm扫描500-1000次的频率进行断面扫描;
10.步骤二:确定理论行进路径
11.将每10次断面扫描进行一次边缘重合,并确定边缘重合的拟合范围,接着将各次断面扫描边缘上拟合重复度最高的点紧进行依次连接,这样可以得到每10次断面扫描的理论边缘,并得到理论拟合中心,同时将10次内的各个断面扫描的扫描中心点提取出来,以理论边缘按相等的距离向理论拟合中心做同心圆靠近,在扫描中心点均匀分布到两侧后停止,之后去掉最内和最外的扫描中心点,接下来将剩余的扫描中心点按照最小二乘法得到扫描中心点的分布轨迹,将分布轨迹的最高点和最低点做经过理论拟合中心的连线,并将上述连线的中心点与理论拟合中心连接,两者的中心即为排水通道的理论中心,接下来将每10次断面扫描对用的理论中心连接起来即可得到理论前进轨迹;
12.步骤三:定义移动机器人的重心前进轨迹
13.定义移动机器人重心对应位置按前进方向相邻两个理论中心连线做法线对应的平面,并要求移动机器人的重心位于上述的平面内,另得到上述两个理论中心与平面的交点a,将交点与移动机器人的重心的连接,将移动机器人前、后轮中心面与排水通道内壁的
接触点连接起来,得到的连线与平面的相交点为轮迹点,位于移动机器人两侧的轮迹点连线与交点a和移动机器人的重心连线相交,得到交点b,移动机器人前进路径中,各个交点b连线即为重心前进轨迹。
14.优选的,所述排水通道的内壁为圆形,这样的得到理论边缘为排水通道的理论内壁轮廓,其对应的理论拟合中心为排水通道理论内壁轮廓的中心。
15.优选的,所述断面扫描为扫描排水通道的内壁轮廓。
16.优选的,所述断面扫描过程中使用移动机器人的高频相机进行拍照。
17.优选的,所述移动机器人采用四个轮子进行运动。
18.(三)有益效果
19.本发明提供了一种基于强化学习的移动机器人路径跟踪方法。具备以下有益效果:
20.本发明中,通过移动机器人得到排水通道内的重心前进轨迹,随着移动机器人在排水通道内的不断移动,可以得到整个城市排水系统新安装的排水通道的重心前进轨迹,为后续清理机器人的清理过程提供追踪路径,过程中也可获得排水通道内部缺陷的位置,便于即使维修,防止使用后出现渗漏的情况。
具体实施方式
21.下面将对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
22.实施例:
23.本发明实施例提供一种基于强化学习的移动机器人路径跟踪方法,包括以下步骤:
24.步骤一:对前进方向进行断面扫描
25.确定移动机器人在排水通道内的前进方向,并使用移动机器人上安装的断面扫描仪对排水通道的内壁按照前进1mm扫描500-1000次的频率进行断面扫描,其具体为排水通道的内壁轮廓,这里扫描的为刚安装布置好未使用的排水通道,排水通道的内壁为圆形;
26.步骤二:确定理论行进路径
27.将每10次断面扫描进行一次边缘重合,并确定边缘重合的拟合范围,接着将各次断面扫描边缘上拟合重复度最高的点紧进行依次连接,这样可以得到每10次断面扫描的理论边缘,并得到理论拟合中心,同时将10次内的各个断面扫描的扫描中心点提取出来,以理论边缘按相等的距离向理论拟合中心做同心圆靠近,在扫描中心点均匀分布到两侧后停止,之后去掉最内和最外的扫描中心点,接下来将剩余的扫描中心点按照最小二乘法得到扫描中心点的分布轨迹,将分布轨迹的最高点和最低点做经过理论拟合中心的连线,并将上述连线的中心点与理论拟合中心连接,两者的中心即为排水通道的理论中心,接下来将每10次断面扫描对用的理论中心连接起来即可得到理论前进轨迹,上述得到的理论边缘为排水通道的理论内壁轮廓,对应的理论拟合中心为排水通道理论内壁轮廓的中心,理论内壁轮廓和理论拟合中心可以避免排水通道内壁局部缺陷或微小弯曲的影响,理论拟合中心
与排水通道生产时的理论中心基本重合;
28.步骤三:定义移动机器人的重心前进轨迹
29.定义移动机器人重心对应位置按前进方向相邻两个理论中心连线做法线对应的平面,并要求移动机器人的重心位于上述的平面内,另得到上述两个理论中心与平面的交点a,将交点与移动机器人的重心的连接,将移动机器人前、后轮中心面与排水通道内壁的接触点连接起来,得到的连线与平面的相交点为轮迹点,位于移动机器人两侧的轮迹点连线与交点a和移动机器人的重心连线相交,得到交点b,移动机器人前进路径中,各个交点b连线即为重心前进轨迹。
30.断面扫描过程中使用移动机器人的高频相机进行拍照,这样可以获得排水通道内壁的缺陷位置。
31.移动机器人采用四个轮子进行运动,移动机器人的四个轮子要求为弹性变形小。
32.尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。


技术特征:
1.一种基于强化学习的移动机器人路径跟踪方法,其特征在于,包括以下步骤:步骤一:对前进方向进行断面扫描确定移动机器人在排水通道内的前进方向,并使用移动机器人上安装的断面扫描仪对排水通道的内壁按照前进1mm扫描500-1000次的频率进行断面扫描;步骤二:确定理论行进路径将每10次断面扫描进行一次边缘重合,并确定边缘重合的拟合范围,接着将各次断面扫描边缘上拟合重复度最高的点紧进行依次连接,这样可以得到每10次断面扫描的理论边缘,并得到理论拟合中心,同时将10次内的各个断面扫描的扫描中心点提取出来,以理论边缘按相等的距离向理论拟合中心做同心圆靠近,在扫描中心点均匀分布到两侧后停止,之后去掉最内和最外的扫描中心点,接下来将剩余的扫描中心点按照最小二乘法得到扫描中心点的分布轨迹,将分布轨迹的最高点和最低点做经过理论拟合中心的连线,并将上述连线的中心点与理论拟合中心连接,两者的中心即为排水通道的理论中心,接下来将每10次断面扫描对用的理论中心连接起来即可得到理论前进轨迹;步骤三:定义移动机器人的重心前进轨迹定义移动机器人重心对应位置按前进方向相邻两个理论中心连线做法线对应的平面,并要求移动机器人的重心位于上述的平面内,另得到上述两个理论中心与平面的交点a,将交点与移动机器人的重心的连接,将移动机器人前、后轮中心面与排水通道内壁的接触点连接起来,得到的连线与平面的相交点为轮迹点,位于移动机器人两侧的轮迹点连线与交点a和移动机器人的重心连线相交,得到交点b,移动机器人前进路径中,各个交点b连线即为重心前进轨迹。2.根据权利要求1所述的一种基于强化学习的移动机器人路径跟踪方法,其特征在于:所述排水通道的内壁为圆形,这样的得到理论边缘为排水通道的理论内壁轮廓,其对应的理论拟合中心为排水通道理论内壁轮廓的中心。3.根据权利要求1所述的一种基于强化学习的移动机器人路径跟踪方法,其特征在于:所述断面扫描为扫描排水通道的内壁轮廓。4.根据权利要求1所述的一种基于强化学习的移动机器人路径跟踪方法,其特征在于:所述断面扫描过程中使用移动机器人的高频相机进行拍照。5.根据权利要求1所述的一种基于强化学习的移动机器人路径跟踪方法,其特征在于:所述移动机器人采用四个轮子进行运动。

技术总结
本发明提供一种基于强化学习的移动机器人路径跟踪方法,涉及机器人路径跟踪技术领域。该基于强化学习的移动机器人路径跟踪方法,包括以下步骤:步骤一,对前进方向进行断面扫描;步骤二,确定理论行进路径;步骤三,定义移动机器人的重心前进轨迹。本发明中,通过移动机器人得到排水通道内的重心前进轨迹,随着移动机器人在排水通道内的不断移动,可以得到整个城市排水系统新安装的排水通道的重心前进轨迹,为后续清理机器人的清理过程提供追踪路径,过程中也可获得排水通道内部缺陷的位置,便于即使维修,防止使用后出现渗漏的情况。防止使用后出现渗漏的情况。


技术研发人员:蒋莉滨 陈旭 钟晓泉 李密 李家维 林雅婷
受保护的技术使用者:福建省海峡智汇科技有限公司
技术研发日:2021.11.02
技术公布日:2022/2/6
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1