基于无线信号强度变化的移动机器人回归路径规划方法技术

公开一种基于无线信号强度变化的移动机器人回归路径规划方法，移动机器人包括驱动轮和与驱动轮连接的驱动电机，设置在移动机器人前端的充电电极公端以及主控电子装置设置，充电基座包括设置充电电极母端、电源插孔，以及充电控制电子装置，充电控制电子装置设置控制器和与控制器连接的第一WIFI模块，主控电子装置设置处理器和与处理器连接的第二WIFI模块，以及设置在处理器中的回归路径规划方法，包括以下过程：首先沿当前方向前进；比较无线信号强度变化的方向，如果变大则保持前进；相反，旋转180度后前进；遇到障碍物则绕障；遇到边界则沿边界行走，同时比较无线信号强度变化的方向，如果变大则继续沿边界行走，相反，旋转180度后再沿边界行走。

Mobile robot regression path planning method based on wireless signal intensity change

A regression path planning method for mobile robots based on the change of wireless signal intensity is disclosed. The mobile robots include driving wheels and driving motors connected with driving wheels. The charging electrodes at the common end of the front end of the mobile robot and the main control electronic device are arranged. The charging base includes the charging electrodes at the mother end and the power socket. The charging control electronic device sets up the controller and the first WIFI module connected with the controller, the main control electronic device sets up the processor and the second WIFI module connected with the processor, and the regression path planning method set up in the processor, including the following processes: first, moving forward in the current direction Comparing the direction of wireless signal intensity change, if it gets bigger, keep moving; on the contrary, rotate 180 degrees to move forward; when encountering obstacles, circle obstacles; when encountering boundary, walk along the boundary, while comparing the direction of wireless signal intensity change, if it gets bigger, continue to walk along the boundary, on the contrary, rotate 180 degrees and then walk along the boundary.

【技术实现步骤摘要】
基于无线信号强度变化的移动机器人回归路径规划方法
本专利技术涉及一种基于无线信号强度变化的移动机器人回归路径规划方法，属于移动机器人领域。
技术介绍
移动机器人已经开始应用在我们的生活中，比如吸尘机器人和割草机器人，机器人的应用一定程度上减轻了日常的劳动负担，是未来技术发展的趋势。目前，移动机器人技术的发展还不是很完善，比如吸尘机器人和割草机器人，在工作结束或者电池耗尽的时候，需要寻找充电基座进行充电。目前常用的方式是沿工作区域的边界进行搜寻，比如吸尘机器人可以沿着墙边搜寻充电基座，而充电基座是靠墙设置的；割草机器人是工作在草坪上，而草坪的周围铺设了交流电缆，充电基座设置在电缆上，所以割草机器人沿着电缆也可以找到充电基座。这种方式在环境复杂，或者面积较大的情况下，平均状况下需要花很长时间才能回到充电基座，并且很可能出现这种情况，充电基座近在咫尺，移动机器人还要从反方向去搜寻。另外，也有采用随机搜集的方式，比如一些吸尘机器人，这种方式效率低下，经常失败。随着技术的发展，目前移动机器人开始装配二维甚至三维激光雷达用于环境检测和地图建立，但是这种方式成本非常高，传感器本身的价格已经远远超过目前移动机器人的成本。也有采用图像传感器进行环境检测与地图建立的，这种方式对硬件计算能力要求高，并且对环境光照条件要求苛刻。而无线wifi网络已经普及到每个家庭及办公环境，其硬件成本非常低，开发资料也很丰富，基于无线wifi网络信号的强度信息来进行移动机器人的位姿估计及路径规划成为一个发展方向。
技术实现思路
本专利技术的目的是为了克服现有技术中的不足之处，采用移动机器人的行进过程中进行数据采集，计算无线信号强度的变化方向，判断当前路径方向是否正确，从而缩短了移动机器人寻找充电基座的时间，提高了效率。本专利技术解决其技术问题所采用的技术方案是：基于无线信号强度变化的移动机器人回归路径规划方法，所述的移动机器人包括驱动轮和与所述的驱动轮连接的驱动电机以及设置在所述的移动机器人前端的充电电极公端，所述的移动机器人内部设置主控电子装置，所述的主控电子装置包括进行集中控制的处理器，与所述的处理器连接的电机驱动电路，所述的电机驱动电路与所述的驱动电机连接，与所述的处理器连接的障碍物检测电路，用于进行避障和路径规划，与所述的处理器连接的标志信号接收装置，用于接收充电基座发出的特征信号，与所述的处理器连接的惯性导航系统，用于计算所述的移动机器人的位置(x,y)和方向θ，还包括与所述的处理器连接的充电电路，所述的充电电路与所述的充电电极公端连接，所述的充电电路输出连接所述的充电电池，所述充电电池输出连接第二电源电路，所述的第二电源电路为后续电路提供电源；所述的充电基座包括充电电极母端、电源插孔，以及充电控制电子装置，所述的充电控制电子装置设置了进行集中控制的控制器，与所述电源插孔连接的第一电源电路和滤波电路，与所述的滤波电路连接的开关管，所述的开关管由所述的控制器控制，输出连接电流检测电路，所述的电流检测电路连接所述的充电电极母端，所述的电流检测电路将电流信号转换成电压信号给所述的控制器，还包括与所述的控制器连接的标志信号发射装置，用于发射特征信号，所述的充电控制电子装置，设置与所述的控制器连接的第一WIFI模块，所述的第一WIFI模块设置为AP模式，所述的主控电子装置设置与所述的处理器连接的第二WIFI模块，所述的第二WIFI模块设置为STA模式，所述的处理器可获取所述的第二WIFI模块接收到的无线信号强度值RSSI，记为R，所述的处理器设置回归路径规划方法，所述的回归路径规划方法包括以下步骤：（1）设置链表L={a(i)}，其中a(i)=Ri，i=0,1,2,3,...10，Ri为不同时刻存储的无线信号强度值，设置表尾指针ep，指向链表L中最新数据的位置；（2）所述的处理器控制所述的第二WIFI模块接入所述的第一WIFI模块的网络，所述的处理器实时获取所述的第二WIFI模块接收到的无线信号强度值R；所述的惯性导航系统实时计算所述的移动机器人的坐标(x,y)和方向θ；（3）所述的移动机器人结束工作或者电量不足，开始寻找所述的充电基座，存储无线信号强度值R，即ep=0，a(ep)=R；（4）所述的移动机器人直线前进；采用行走距离累计算法，计算所述的移动机器人走过的距离d，当距离d>10cm，存储无线信号强度值R至L，即ep++，a(ep)=R，当ep等于10时，进入步骤5；当所述的移动机器人检测到障碍物，旋转任意角度，返回步骤3；（5）比较a(0)与a(j)的大小，其中，j=1,2,3,...10：初始化计数器k=0；如果a(0)>a(j)，则k++；如果j>5，则进入步骤6，否则所述的移动机器人旋转180度后，进入步骤6；（6）所述的移动机器人直线前进；当所述的移动机器人检测到障碍物，存储无线信号强度值R，即ep=0，a(ep)=R，记录方向角θx=θ，然后以左侧沿着障碍物行走，当|R-a(0)|>δ时，进入步骤7；（7）所述的移动机器人以左侧沿着障碍物行走；采用行走距离累计算法，计算所述的移动机器人的行走距离d，当距离d>10cm，存储无线信号强度值R至L，即ep++，a(ep)=R，当ep等于10时，进入步骤8；当|R-a(0)|<δ，其中δ设置为接近于零的阈值，旋转到角度θx，返回步骤6；（8）比较a(0)与a(j)的大小，其中，j=1,2,3,...10：初始化计数器k=0；如果a(0)>a(j)，则k++；如果k>5，则进入步骤9，否则所述的移动机器人向右旋转并以右侧沿着障碍物行走，进入步骤9；（9）当|R-a(0)|<δ时，所述的移动机器人旋转到角度θx，返回步骤6；当所述的标志信号接收装置接收到所述的标志信号发射装置发出的特征信号，结束退出。所述的行走距离累计算法设置为：初始化行走距离d=0；设置计算周期T；在当前计算周期T的初始时刻，存储初始位置x0=x，y0=y；计算周期T结束时，计算当前计算周期T内所述的移动机器人的行走距离Δd=；对Δd进行累计，可得行走距离d=d+Δd，然后进入下一个计算周期T。实施本专利技术的积极效果是：1、无线信号覆盖范围广，在移动机器人行进过程中进行数据采集，通过计算无线信号强度的变化方向，判断充电基座跟当前行进方向是否一致；2、不需要环境设置及改造，成本低。附图说明图1是回归路径规划过程示意图；图2是主控电子装置的原理框图；图3是充电控制电子装置的原理框图。具体实施方式现结合附图对本专利技术作进一步说明：参照图1－3，基于路径和RSSI的移动机器人定位充电基座的智能控制方法，所述的移动机器人21包括驱动轮和与所述的驱动轮连接的驱动电机11以及设置在所述的移动机器人21前端的充电电极公端6。基于所述的驱动轮，所述的移动机器人21可以实现自由移动，可以设置为两个驱动轮和一个支撑轮；所述的充电电极公端6设置为两个分开的铜质电极，与外部电源连接时进行充电。所述的移动机器人21内部设置主控电子装置，所述的主控电子装置包括进行集中控制的处理器1，所述的处理器1可采用低功耗微处理器，具体可本文档来自技高网...

【技术保护点】
1.基于无线信号强度变化的移动机器人回归路径规划方法，所述的移动机器人包括驱动轮和与所述的驱动轮连接的驱动电机以及设置在所述的移动机器人前端的充电电极公端，所述的移动机器人内部设置主控电子装置，所述的主控电子装置包括进行集中控制的处理器，与所述的处理器连接的电机驱动电路，所述的电机驱动电路与所述的驱动电机连接，与所述的处理器连接的障碍物检测电路，用于进行避障和路径规划，与所述的处理器连接的标志信号接收装置，用于接收充电基座发出的特征信号，与所述的处理器连接的惯性导航系统，用于计算所述的移动机器人的位置(x,y)和方向θ，还包括与所述的处理器连接的充电电路，所述的充电电路与所述的充电电极公端连接，所述的充电电路输出连接所述的充电电池，所述充电电池输出连接第二电源电路，所述的第二电源电路为后续电路提供电源；所述的充电基座包括充电电极母端、电源插孔，以及充电控制电子装置，所述的充电控制电子装置设置了进行集中控制的控制器，与所述电源插孔连接的第一电源电路和滤波电路，与所述的滤波电路连接的开关管，所述的开关管由所述的控制器控制，输出连接电流检测电路，所述的电流检测电路连接所述的充电电极母端，所述的电流检测电路将电流信号转换成电压信号给所述的控制器，还包括与所述的控制器连接的标志信号发射装置，用于发射特征信号，所述的充电控制电子装置，设置与所述的控制器连接的第一WIFI模块，所述的第一WIFI模块设置为AP模式，所述的主控电子装置设置与所述的处理器连接的第二WIFI模块，所述的第二WIFI模块设置为STA模式，所述的处理器可获取所述的第二WIFI模块接收到的无线信号强度值RSSI，记为R，其特征在于：所述的处理器设置回归路径规划方法，所述的回归路径规划方法包括以下步骤：(1) 设置链表L={a(i)}，其中a(i)=Ri，i=0,1,2,3,...10，Ri为不同时刻存储的无线信号强度值，设置表尾指针ep，指向链表L中最新数据的位置；(2) 所述的处理器控制所述的第二WIFI模块接入所述的第一WIFI模块的网络，所述的处理器实时获取所述的第二WIFI模块接收到的无线信号强度值R；所述的惯性导航系统实时计算所述的移动机器人的坐标(x,y)和方向θ；(3) 所述的移动机器人结束工作或者电量不足，开始寻找所述的充电基座，存储无线信号强度值R，即ep=0，a(ep)=R；(4) 所述的移动机器人直线前进；采用行走距离累计算法，计算所述的移动机器人走过的距离d，当距离d>10cm，存储无线信号强度值R至L，即ep++，a(ep)=R，当ep等于10时，进入步骤5；当所述的移动机器人检测到障碍物，旋转任意角度，返回步骤3；(5) 比较a(0)与a(j)的大小，其中，j=1,2,3,...10：初始化计数器k=0；如果a(0)>a(j)，则k++；如果j>5，则进入步骤6，否则所述的移动机器人旋转180度后，进入步骤6；(6) 所述的移动机器人直线前进；当所述的移动机器人检测到障碍物，存储无线信号强度值R，即ep=0，a(ep)=R，记录方向角θx=θ，然后以左侧沿着障碍物行走，当|R‑a(0)|>δ时，进入步骤7；(7) 所述的移动机器人以左侧沿着障碍物行走；采用行走距离累计算法，计算所述的移动机器人的行走距离d，当距离d>10cm，存储无线信号强度值R至L，即ep++，a(ep)=R，当ep等于10时，进入步骤8；当|R‑a(0)|...

【技术特征摘要】
1.基于无线信号强度变化的移动机器人回归路径规划方法，所述的移动机器人包括驱动轮和与所述的驱动轮连接的驱动电机以及设置在所述的移动机器人前端的充电电极公端，所述的移动机器人内部设置主控电子装置，所述的主控电子装置包括进行集中控制的处理器，与所述的处理器连接的电机驱动电路，所述的电机驱动电路与所述的驱动电机连接，与所述的处理器连接的障碍物检测电路，用于进行避障和路径规划，与所述的处理器连接的标志信号接收装置，用于接收充电基座发出的特征信号，与所述的处理器连接的惯性导航系统，用于计算所述的移动机器人的位置(x,y)和方向θ，还包括与所述的处理器连接的充电电路，所述的充电电路与所述的充电电极公端连接，所述的充电电路输出连接所述的充电电池，所述充电电池输出连接第二电源电路，所述的第二电源电路为后续电路提供电源；所述的充电基座包括充电电极母端、电源插孔，以及充电控制电子装置，所述的充电控制电子装置设置了进行集中控制的控制器，与所述电源插孔连接的第一电源电路和滤波电路，与所述的滤波电路连接的开关管，所述的开关管由所述的控制器控制，输出连接电流检测电路，所述的电流检测电路连接所述的充电电极母端，所述的电流检测电路将电流信号转换成电压信号给所述的控制器，还包括与所述的控制器连接的标志信号发射装置，用于发射特征信号，所述的充电控制电子装置，设置与所述的控制器连接的第一WIFI模块，所述的第一WIFI模块设置为AP模式，所述的主控电子装置设置与所述的处理器连接的第二WIFI模块，所述的第二WIFI模块设置为STA模式，所述的处理器可获取所述的第二WIFI模块接收到的无线信号强度值RSSI，记为R，其特征在于：所述的处理器设置回归路径规划方法，所述的回归路径规划方法包括以下步骤：(1)设置链表L={a(i)}，其中a(i)=Ri，i=0,1,2,3,...10，Ri为不同时刻存储的无线信号强度值，设置表尾指针ep，指向链表L中最新数据的位置；(2)所述的处理器控制所述的第二WIFI模块接入所述的第一WIFI模块的网络，所述的处理器实时获取所述的第二WIFI模块接收到的无线信号强度值R；所述的惯性导航系统实时计算所述的移动机器人的坐标(x,y)和方向θ；(3)所述的移动...

【专利技术属性】
技术研发人员：刘瑜，
申请(专利权)人：杭州晶一智能科技有限公司，
类型：发明
国别省市：浙江,33