基于无线信号RSSI的移动机器人定位充电基座方向的控制
方法
技术领域
本发明涉及一种基于无线信号RSSI的移动机器人定位充电基座的控制方法,属于移动机器人领域。
背景技术
移动机器人已经开始应用在我们的生活中,比如吸尘机器人和割草机器人,机器人的应用一定程度上减轻了日常的劳动负担,是未来技术发展的趋势。
目前,移动机器人技术的发展还不是很完善,比如吸尘机器人和割草机器人,在工作结束或者电池耗尽的时候,需要寻找充电基座进行充电。目前常用的方式是沿工作区域的边界进行搜寻,比如吸尘机器人可以沿着墙边搜寻充电基座,而充电基座是靠墙设置的;割草机器人是工作在草坪上,而草坪的周围铺设了交流电缆,充电基座设置在电缆上,所以割草机器人沿着电缆也可以找到充电基座。这种方式在环境复杂,或者面积较大的情况下,平均状况下需要花很长时间才能回到充电基座,并且很可能出现这种情况,充电基座近在咫尺,移动机器人还要从反方向去搜寻。另外,也有采用随机搜集的方式,比如一些吸尘机器人,这种方式效率低下,经常失败。
随着技术的发展,目前移动机器人开始装配二维甚至三维激光雷达用于环境检测和地图建立,但是这种方式成本非常高,传感器本身的价格已经远远超过目前移动机器人的成本。也有采用图像传感器进行环境检测与地图建立的,这种方式对硬件计算能力要求高,并且对环境光照条件要求苛刻。
发明内容
本发明的目的是为了克服现有技术中的不足之处,采用大范围无线信号的强度信息来计算充电基座的方向,缩短了移动机器人定位充电基座的时间,提高了效率。
本发明解决其技术问题所采用的技术方案是:
基于无线信号RSSI的移动机器人定位充电基座方向的控制方法,所述的移动机器人包括驱动轮和与所述的驱动轮连接的驱动电机以及设置在所述的移动机器人前端的充电电极公端,所述的移动机器人内部设置主控电子装置,所述的主控电子装置包括进行集中控制的处理器,与所述的处理器连接的电机驱动电路,所述的电机驱动电路与所述的驱动电机连接,与所述的处理器连接的障碍物检测电路,用于进行避障和路径规划,与所述的处理器连接的标志信号接收装置,用于接收充电基座发出的特征信号,与所述的处理器连接的惯性导航系统,用于计算所述的移动机器人的位置(x,y)和方向θ,还包括与所述的处理器连接的充电电路,所述的充电电路与所述的充电电极公端连接,所述的充电电路输出连接充电电池,所述充电电池输出连接第二电源电路,所述的第二电源电路为后续电路提供电源;所述的充电基座包括充电电极母端、电源插孔,以及充电控制电子装置,所述的充电控制电子装置设置了进行集中控制的控制器,与所述电源插孔连接的第一电源电路和滤波电路,与所述的滤波电路连接的开关管,所述的开关管由所述的控制器控制,输出连接电流检测电路,所述的电流检测电路连接所述的充电电极母端,所述的电流检测电路将电流信号转换成电压信号给所述的控制器,还包括与所述的控制器连接的标志信号发射装置,用于发射特征信号,所述的充电控制电子装置,设置与所述的控制器连接的第一WIFI模块,所述的第一WIFI模块设置为AP模式,所述的主控电子装置设置与所述的处理器连接的第二WIFI模块,所述的第二WIFI模块设置为STA模式,所述的处理器可获取所述的第二WIFI模块接收到的无线信号强度值RSSI,记为R,以及设置在所述的处理器中的充电基座定向控制方法,所述的充电基座定向控制方法包括以下步骤:
(1)所述的处理器控制所述的第二WIFI模块接入所述的第一WIFI模块的网络;
(2)所述的移动机器人从当前位置顺时针或者逆时针旋转,旋转直径为D,每隔固定时间T记录位置(xi,yi),方向θi和无线信号强度值Ri,i=0,1,2,3.....,回到起始点附近后结束进入步骤3;
(3)采用数据处理算法,计算所述的充电基座的方向α。
步骤3中,所述的数据处理算法设置为:
通过比较运算,求无线信号强度的最大和最小值:R
max和R
min,即i=max时,无线信号强度值R最大;i=min时,无线信号强度值R最小;然后计算所述的充电基座的方向为:α=
。
步骤3中,所述的数据处理算法也可设置为:
计算无线信号强度的差分值,即ΔRi=Ri-Ri-1,当i=0时,ΔR0=R0-RN-1,其中,N为记录数据的数量,并求差分值ΔRi的最大和最小值:ΔRmax和ΔRmin,即i=max时,无线信号强度的差分值ΔR最大;i=min时,无线信号强度的差分值ΔR最小;然后,计算所述的充电基座的方向为:α=(θmax-θmin)/2。
所述的标志信号发射装置设置为红外信号发射装置,所述的标志信号接收装置设置为红外信号接收装置。
所述的标志信号接收装置设置在所述移动机器人的前面,所述的标志信号发射装置设置在所述的充电基座的前端,所述的标志信号接收装置和标志信号发射装置设置同样的高度。
实施本发明的积极效果是:1、无线信号覆盖范围广,可以帮助移动机器人迅速确定充电基座的方向,缩短回归充电的时间;2、不需要环境设置及改造,成本低。
附图说明
图1是充电基座定向过程示意图;
图2是主控电子装置的原理框图;
图3是充电控制电子装置的原理框图。
具体实施方式
现结合附图对本发明作进一步说明:
参照图1-3,基于无线信号RSSI的移动机器人定位充电基座方向的控制方法,所述的移动机器人21包括驱动轮和与所述的驱动轮连接的驱动电机11以及设置在所述的移动机器人21前端的充电电极公端6。基于所述的驱动轮,所述的移动机器人21可以实现自由移动,可以设置为两个驱动轮和一个支撑轮;所述的充电电极公端6设置为两个分开的铜质电极,与外部电源连接时进行充电。
所述的移动机器人21内部设置主控电子装置,所述的主控电子装置包括进行集中控制的处理器1,所述的处理器1可采用低功耗微处理器,具体可采用TI公司的MSP430,或者普通处理器,比如ST公司的32位ARM处理器STM32F103C8T6;与所述的处理器1连接的电机驱动电路7,所述的电机驱动电路7与所述的驱动电机11连接,在所述的处理器1的控制下,所述的电机驱动电路7带动所述的驱动电机11,所述的驱动电机11带动所述的驱动轮,实现所述的移动机器人21的自由移动;与所述的处理器1连接的障碍物检测电路8,用于进行避障和路径规划,可以采用超声波或者红外传感器或者两种传感器的组合;与所述的处理器1连接的标志信号接收装置9,用于接收充电基座20发出的特征信号;与所述的处理器1连接的惯性导航系统10,设置为安装在所述的驱动电机11上的编码器,用于计算所述的移动机器人21的位置(x,y)和方向θ,由于计算误差,机械间隙及地面打滑,所述的惯性导航系统10具有累计误差,但是在一段时间内,误差较小,具有使用价值;还包括与所述的处理器1连接的充电电路5,所述的充电电路5与所述的充电电极公端6连接,所述的充电电路5输出连接充电电池4,所述充电电池4输出连接第二电源电路2,所述的第二电源电路2为后续电路提供电源。
所述的充电基座20包括充电电极母端17、电源插孔,以及充电控制电子装置。所述的电源插孔可连接外部电源适配器,为所述的充电基座20各个组成部分提供电源;所述的充电电极母端17设置为两个分开的铜质电极,具有弹性,与所述的充电电极公端6对应,正极对正极,负极对负极,高度相同。
所述的充电控制电子装置设置了进行集中控制的控制器12,因为功能较单一,可采用MICROCHIP的PIC16F1503单片机;与所述的电源插孔连接的第一电源电路13和滤波电路14,与所述的滤波电路14连接的开关管15,所述的开关管15由所述的控制器12控制,输出连接电流检测电路16,所述的电流检测电路16连接所述的充电电极母端17,所述的电流检测电路16将电流信号转换成电压信号给所述的控制器12,所述的控制器12可控制输出电流的大小,并且防止所述的充电电极母端17短路;还包括与所述的控制器12连接的标志信号发射装置18,用于发射特征信号。
所述的标志信号发射装置18设置为红外信号发射装置,所述的标志信号接收装置9设置为红外信号接收装置。红外信号指向性好,并且便于设置其发射角度和范围。所述的标志信号接收装置9设置在所述移动机器人21的前面,所述的标志信号发射装置18设置在所述的充基电座的前端,所述的标志信号接收装置9和标志信号发射装置18设置同样的高度。
所述的充电控制电子装置,设置与所述的控制器12连接的第一WIFI模块19,所述的第一WIFI模块19设置为AP模式,即无线接入点,是一个无线网络的中心节点;所述的主控电子装置设置与所述的处理器1连接的第二WIFI模块3,所述的第二WIFI模块3设置为STA模式,即无线站点,是一个无线网络的终端,所述的处理器1可获取所述的第二WIFI模块3接收到的无线信号强度值RSSI,记为R。所述的第一WIFI模块19和第二WIFI模块3可设置为IOT芯片ESP8266,具有价格低,变成简便的优点。
所述的处理器1设置充电基座定向控制方法,,所述的充电基座定向控制方法包括以下步骤:
(1)所述的处理器1控制所述的第二WIFI模块3接入所述的第一WIFI模块19的网络;
所述的处理器1以网络名称和密码作为参数,发送AT+CWJAP指令给所述的第二WIFI模块3,就可以接入所述的第一WIFI模块19的网络。
(2)所述的移动机器人21从当前位置顺时针或者逆时针旋转,旋转直径为D,每隔固定时间T记录位置(xi,yi),方向θi和无线信号强度值Ri,i=0,1,2,3.....,回到起始点附近后结束进入步骤3;
其中,旋转直径D根据所述的移动机器人21的工作环境确定,比如吸尘机器人的工作环境一般比较狭小,以1米为宜,而割草机器人的工作环境宽敞,可确定为2m;固定时间T为采样周期,根据精度需要进行调整,一般可设置为1秒;所述的处理器1以网络名称作为参数,发送AT+CWLAP给所述的第二WIFI模块3,可获取当前位置的所述的第一WIFI模块19的无线网络信号强度Ri。
(3)采用数据处理算法,计算所述的充电基座20的方向α。
步骤3中,所述的数据处理算法设置为:
通过比较运算,求无线信号强度的最大和最小值:R
max和R
min,即i=max时,无线信号强度值R最大;i=min时,无线信号强度值R最小;然后计算所述的充电基座20的方向为:α=
。
参照附图1,在无线网络覆盖范围内,信号是以所述的第一WIFI模块19为中心,向四周传播的。因此在所述的移动机器人21的圆形运动轨迹上,无线信号强度的最大值Rmax和最小值Rmin的位置分别是距离所述的第一WIFI模块19的最远和最近的位置,两个位置的连线一定指向所述的第一WIFI模块19。
步骤3中,所述的数据处理算法也可设置为:
计算无线信号强度的差分值,即ΔRi=Ri-Ri-1,当i=0时,ΔR0=R0-RN-1,其中,N为记录数据的数量,并求差分值ΔRi的最大和最小值:ΔRmax和ΔRmin,即i=max时,无线信号强度的差分值ΔR最大;i=min时,无线信号强度的差分值ΔR最小;然后,计算所述的充电基座20的方向为:α=(θmax-θmin)/2。
参照附图1,在无线网络覆盖范围内,信号是以所述的第一WIFI模块19为中心,向四周传播的。在与所述的第一WIFI模块19的连线方向上,具有最大的无线信号强度梯度。因此在所述的移动机器人21的圆形运动轨迹上,无线信号强度的差分最大值ΔRmax和最小值ΔRmin分别位于圆形运动轨迹的两侧,并且与所述的第一WIFI模块19的连线与圆形运动轨迹相切,一个指向所述的第一WIFI模块19,另一个指向所述的第一WIFI模块19的反方向。两个方向的绝对值相加求平均,即为所述的充电基座20的方向。
综上所述,所述的移动机器人21在结束工作或者电量不足时,可以顺时针或者逆时针旋转一周,记录位置,方向和无线网络信号强度值,可计算所述的充电基座20的方向,然后根据所述的充电基座20的特征信号精确定位,最后对接充电,因此该方案可大大缩小的充电基座20搜寻范围,大大提高回归充电效率。