CN103576681B - 自动行走设备及其控制方法 - Google Patents
自动行走设备及其控制方法 Download PDFInfo
- Publication number
- CN103576681B CN103576681B CN201210261668.2A CN201210261668A CN103576681B CN 103576681 B CN103576681 B CN 103576681B CN 201210261668 A CN201210261668 A CN 201210261668A CN 103576681 B CN103576681 B CN 103576681B
- Authority
- CN
- China
- Prior art keywords
- automatic running
- energy level
- power module
- running device
- module
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Charge And Discharge Circuits For Batteries Or The Like (AREA)
Abstract
本发明涉及一种自动行走设备及其控制方法,一种自动行走设备回归停靠站的控制方法,所述自动行走设备包括提供能量的电源模块,所述控制方法包括如下步骤:控制自动行走设备启动回归;检测电源模块的能量水平;计算电源模块的能量水平的变化率;当所述变化率达到或超过预设门限值时,控制自动行走设备停止回归。本发明通过在回归的过程中,实时获知能源模块的能量水平的变化率,并判断所述变化率是否达到或超过预设门限值,实现适时地控制自动行走设备停止回归,避免了自动行走设备持续不断的执行回归而导致电源模块的过放损坏,达到了保护电源模块,延长其寿命的效果。
Description
技术领域
本发明涉及一种自动行走设备,特别是一种在回归停靠站时,具有电源模块过放保护功能的自动行走设备。
本发明还涉及一种自动行走设备的控制方法,特别是一种实现在回归停靠站时对电源模块进行过放保护的自动行走设备的控制方法。
背景技术
随着科学技术的发展,智能化的自动行走设备逐渐为人们所熟知。由于自动行走设备可以自动按照预设程序执行相关任务,无须人工操作与干预,因此在工业应用及家居产品上的应用非常广泛,例如,工业上的应用有执行各种功能的机器人,家居产品上的应用有割草机、吸尘器等。这些智能的自动行走设备极大地节省了人们的时间,降低了人们的劳动强度,从而提高了生产效率或生活品质。
自动行走设备往往使用可充电的电池包作为能量源,并能够自动返回充电站充电。但由于电池包过放后会损坏,通常,自动行走设备在电池包的能量下降到了一个较低的预设水平,但还未达到过放的程度时,会启动返回充电站充电的动作。自动行走设备一般都能够在过放之前返回充电站。然而,由于很多工作区域的环境复杂多变,工作和回归中也时常会发生一些预料之外的情况,自动行走设备有可能在回归充电站的时候发生困难,从而持续行走,使电池包过放而损坏。
另外一种情况是,一些间歇性或季节性工作的自动行走设备,会在存放很久之后再拿出来使用。例如割草机,在冬季不需要割草时往往被存储起来,到春天草坪再度生长的时候再取出来使用。这种情况下,自动行走设备的电源模块由于自放电会自然损耗到一个很低的能量水平,该能量水平可能远低于返回充电的预设能量水平。此时,自动行走设备若仍然按照正常流程进行寻找和返回充电站的动作,也很可能使电源模块过放而损坏。
发明内容
本发明解决的技术问题为:提供一种能够避免自动回归时电源模块过放损坏的自动行走设备的控制方法。
为解决上述技术问题,本发明的技术方案是:一种自动行走设备回归停靠站的控制方法,所述自动行走设备包括提供能量的电源模块,所述控制方法包括如下步骤:控制自动行走设备启动回归;检测电源模块的能量水平;计算电源模块的能量水平的变化率;当所述能量水平的变化率的绝对值达到或超过预设门限值时,控制自动行走设备停止回归。
优选地,所述控制方法还包括设定预设门限值的步骤。
优选地,根据电源模块的类型、负载水平或放电温度中的至少一个参数,设定预设门限值。
优选地,所述能量水平的变化率为能量水平对时间的一阶导数、二阶导数或高阶导数。
优选地,所述电源模块的能量水平以电源模块的电压或/和放电电流表示。
优选地,所述电源模块包括具有至少一个电池单元的电池包,所述电源模块的能量水平为电池包整包的能量水平或电池单元的能量水平中的至少一个。
优选地,当电源模块的能量水平低于预设能量水平时,控制自动行走设备启动回归。
优选地,当电源模块的能量水平的变化率的绝对值低于预设门限值时,驱动自动行走设备向停靠站行走。
优选地,驱动自动行走设备向停靠站行走的过程中,当自动行走设备回归到停靠站时,控制自动行走设备停止回归。
优选地,所述驱动自动行走设备向停靠站行走的步骤包括:寻找与停靠站位置相关的引导信号;根据引导信号驱动自动行走设备向停靠站行走。
优选地,所述引导信号为引导线上的电信号,所述引导线连接到停靠站,所述驱动自动行走设备向停靠站行走的步骤具体为:寻找所述电信号;根据所述电信号行走至引导线,驱动自动行走设备沿所述引导线向停靠站行走。
优选地,所述自动行走设备执行吸尘工作或割草工作。
本发明的有益效果为:通过在回归的过程中,实时获知能源模块的能量水平的变化率,并判断所述变化率是否达到或超过预设门限值,实现适时地控制自动行走设备停止回归,避免了自动行走设备持续不断的执行回归而导致电源模块的过放损坏,达到了保护电源模块,延长其寿命的效果。
本发明解决的另一技术问题为:提供一种能够避免自动回归时电源模块过放损坏的自动行走设备。
为解决上述技术问题,本发明提供的技术方案为:一种自动行走设备,可选择地回归到停靠站,所述自动行走设备包括:行走模块,驱动自动行走设备行走;电源模块,为自动行走设备提供能量;能量检测单元,检测电源模块的能量水平;控制模块,通过能量检测单元获取当前电源模块的能量水平,并控制行走模块的工作状态,控制模块控制行走模块驱动自动行走设备回归停靠站,控制模块根据当前电源模块的能量水平计算电源模块的能量水平的变化率,当所述能量水平的变化率的绝对值达到或超过预设门限值时,控制模块控制行走模块停止行走。
优选地,所述控制模块在工作过程中设定所述预设门限值。
优选地,所述自动行走设备还包括标识电源模块类型的类型标识单元,所述控制模块根据所述类型标识单元传递的信号设定所述预设门限值。
优选地,所述自动行走设备还包括检测电源模块的负载水平的负载检测单元,所述控制模块根据负载检测单元传递的信号设定所述预设门限值。
优选地,所述能量检测单元检测电源模块的放电温度,所述控制模块根据能量检测单元传递的信号设定所述预设门限值。
优选地,所述能量水平的变化率为能量水平对时间的一阶导数、二阶导数或高阶导数。
优选地,所述电源模块的能量水平以电源模块的电压或/和放电电流表示。
优选地,所述电源模块包括具有至少一个电池单元的电池包,所述电源模块的能量水平为电池包整包的能量水平或电池单元的能量水平中的至少一个。
优选地,控制模块确认当前电源模块的能量水平低于预设能量水平时,控制行走模块驱动自动行走设备回归停靠站。
优选地,控制模块确认电源模块的能量水平的变化率的绝对值低于预设门限值时,控制行走模块驱动自动行走设备向停靠站行走。
优选地,在自动行走设备向停靠站行走的过程中,控制模块确认自动行走设备回归到停靠站时,控制行走模块停止行走。
优选地,所述自动行走设备还包括引导信号感应单元,所述引导信号感应单元感应与停靠站的位置相关的引导信号,所述控制模块根据引导信号控制行走模块,驱动自动行走设备向停靠站行走。
优选地,所述引导信号为引导线上的电信号,所述引导线连接到停靠站;所述引导信号感应单元感应所述电信号,控制模块根据感应到的电信号,控制行走模块行驶至引导线,沿所述引导线驱动自动行走设备向停靠站行走。
优选地,所述自动行走设备还包括工作模块,所述工作模块执行割草工作或吸尘工作。
本发明的有益效果为:通过在回归的过程中,控制模块实时获知能源模块的能量水平的变化率,并判断所述变化率是否达到或超过预设门限值,实现适时地控制自动行走设备停止回归,避免了自动行走设备持续不断的执行回归而导致电源模块的过放损坏,达到了保护电源模块,延长其寿命的效果。
附图说明
以上所述的本发明解决的技术问题、技术方案以及有益效果可以通过下面的能够实现本发明的较佳的具体实施例的详细描述,同时结合附图描述而清楚地获得。
附图以及说明书中的相同的标号和符号用于代表相同的或者等同的元件。
图1是本发明一种较佳实施方式的自动行走设备工作系统的示意图;
图2是图1中所示的自动行走设备的电路模块图;
图3是图1所示实施方式的工作流程;
图4为图1所示实施方式的电源模块放电曲线图。
2 自动行走设备 18 能量检测单元
4 充电站 20 引导信号感应单元
6 充电引导线 22 处理器
8 滚轮 24 存储器
10 控制模块 26 负载检测单元
12 行走模块 28 类型标识单元
14 电源模块 I 电信号
16 工作模块
具体实施方式
有关本发明的详细说明和技术内容,配合附图说明如下,然而所附附图仅提供参考与说明,并非用来对本发明加以限制。
图1所示为本发明的一种较佳实施方式的自动行走设备工作系统的示意图。自动行走设备工作系统包括自动行走设备2、充电站 4以及和充电站 4相连接的充电引导线 6,充电引导线 6作为回归时的引导信号发射单元。在本实施例中,充电引导线6从充电站4引出,围绕自动行走设备2的工作范围一周后回到充电站4,同时还形成自动行走设备工作系统的边界线,充电引导线6围成的区域以内为工作区域,充电引导线6围成的区域以外为非工作区域。
结合图2,自动行走设备2主要包括控制模块10、行走模块12、电源模块14、工作模块16、能量检测单元18、引导信号感应单元20、负载检测单元26以及类型标识单元28。
控制模块10是自动行走设备2的控制中枢,和其他各个模块相连接,接收其他各个模块发来的信息,并控制自动行走设备2执行行走、工作、返回充电站4以及充电等各类动作或任务。控制模块10具体包括处理器22、存储器24等,其具体结果和功能后续描述。
行走模块12包括位于自动行走设备2内的马达和由所述马达驱动的滚轮8,用于接受控制模块10的指令,由电源模块14提供能量,带动自动行走设备2在地面或其他工作表面上自动行走。在本实施例中,行走模块12具体包括位于自动行走设备2两侧的两个驱动轮,分别连接在两个驱动轮上的两个驱动马达,以及位于自动行走设备2前部的一个或两个支撑轮。这样的设置能够通过控制两个驱动轮的速度和速度差,来控制行走模块12的行驶速度和方向,使得自动行走设备2的行走和转向灵活而准确。行走模块12可以有其他的组成形式,例如其可以为驱动轮以及与之连接的独立驱动马达和独立转向马达;还可以为履带式等其他形式。
工作模块16用于执行自动行走设备2所负责的具体工作。工作模块16通常包括工作马达和被工作马达驱动的工作单元。若自动行走设备2为吸尘器,则工作单元为执行吸尘工作的吸尘部件如:吸尘口、风扇和真空室等;若自动行走设备2为割草机,则工作单元为执行切割工作的切割部件如:输出轴和刀盘、刀片等,在此不再赘述。
电源模块14为自动行走设备2的各个模块提供工作的能量,其包括可充电的电池包、以及和电池包连接的充电端子。充电端子适于和充电站4上的电源端子相配接,以连接到外部电源上,为电池包补充能量。电源模块14也可以为其它可再充电设备,如包括超级电容的可再充电设备等。在本具体实施方式中,以电源模块14为具有7节锂电池单元的电池包,其额定电压为28V,额定容量为2000mAh。
能量检测单元18连接电源模块14和控制模块10,用于检测电源模块14中的电池包的能量水平并将表示该能量水平的信号发送给控制模块10。在本实施例中,能量检测单元18通过检测电池包的电压来检测电池包的能量水平,即能量检测单元18为电池包的电压检测电路,其检测到电池包的电压值后,将表示该电压值的信号发送给控制模块10。当然,能量检测单元18也可以采用其他直接或间接的方式检测电池包的能量水平,如检测电池包的剩余容量、放电电流、放电时间、放电温度等。能量检测单元18既可以检测电池包整包的能量水平,也可以检测电池单元的能量水平,还可以同时检测电池包整包的能量水平和电池单元的能量水平,其中电池单元的能量水平可以是某一个电池单元的能量水平、某几个电池单元的能量水平或者每一个电池单元的能量水平。电池包的能量检测单元18的各种具体实现形式是本领域的技术人员所熟知的,在此不进行细节描述。
引导信号感应单元20和引导信号发射单元共同组成一个回归引导系统,用于引导自动行走设备2返回充电站4。
在本实施例中,引导信号发射单元具体为一个电信号发生器,该信号发生器与自动行走设备2相分离,以及连接该电信号发生器的充电引导线6,电信号发生器向充电引导线6上发出电信号I,作为引导自动行走设备2向充电站行走的引导信号,该信号发生器优选的集成在充电站4中。引导信号感应单元20具体为一个或多个位于自动行走设备2上的电感。充电引导线6上携带有变化的电流信号I,其会在周围的空间中产生相应的变化的磁场,而电感通过感应空间中的变化磁场而感应充电引导线6的信号,并将感应到的信号传递给控制模块10。控制模块10分析感应到的信号的各个特征,如感应时间,信号强弱,信号间隔等,判断自动行走设备2相对充电引导线6的相对位置,距离远近。这样,在需要回归时,控制模块10根据得到的信息,发送指令给行走模块12,令其带动自动行走设备2行驶到充电引导线6附近或者充电引导线6的上方,进而沿充电引导线6返回充电站4。
回归引导系统还可以有其他的实现方式。引导信号发射单元可以为超声波发射装置,而引导信号感应单元20可以为对应的超声波感应装置,回归引导系统通过超声波定位充电站4的位置,而引导自动行走设备2返回充电站4。引导信号发射单元还可以为红外线发射装置,而引导信号感应单元20可以为对应的红外线感应装置,回归引导系统通过红外线定位充电站4的位置,而引导自动行走设备2返回充电站4。引导信号发射单元还可以为安装在自动行走设备2上的图像采集装置,而引导信号感应单元则为图像识别装置,其中图像识别装置根据图像采集装置采集的图像信息确认与充电站4位置相关的引导信号。引导信号发射单元还可以为GPS卫星,而引导信号感应单元则为安装在自动行走设备2上的GPS芯片,GPS芯片通过GPS卫星确定自动行走设备2相对充电站4的位置,从而确定与充电站4位置相关的引导信号。
负载检测单元26连接电源模块14和控制模块10,用于检测电源模块14的负载水平,即自动行走设备2对电源模块14的能量的消耗状态。可以通过检测电源模块14的放电电流、放电电压、放电温度等多种方式来识别电源模块14的负载水平。具体到本实施方式中,负载检测单元26检测电源模块14的放电电流,并将检测到的放电电流值实时地传递给控制模块10,便于控制模块10根据其传递的信号,进行相应的处理和控制。
类型标识单元28连接电源模块14和控制模块10,可以用于标识电源模块14的类型,如电源模块14的化学类型、电压类型等。类型标识单元28可以为设置在电源模块14内的识别电阻,也可以为设置在电源模块14内或外的识别电路。具体到本实施方式中,类型标识单元28为设置在电源模块14内的识别电阻,控制模块10通过获知类型标识单元28具有的电阻阻值即可获知电源模块14的类型。
在以上所介绍的各个部分的共同协作之下,本发明通过下面所描述的流程或者说方法来实现回归充电,以及回归充电过程中的电池包过放保护。
如图3所示的工作流程图既适用于自动行走设备2执行工作过程中即工作模块16执行工作过程中的回归充电判断、回归充电执行和电池包保护,也适用于自动行走设备2开机时即工作模块16尚未启动工作时的回归充电判断、回归充电执行和电池包保护。
在初始步骤S0中,自动行走设备2处于开机状态,此时自动行走设备2尚未开始执行工作。
随后进入步骤S1,控制模块10通过能量检测单元18监测电池包的能量水平。电池包的能量水平可以为电池包的剩余容量、放电电压、放电电流、放电时间、放电温度等;电池包的能量水平可以是电池包整包的能量水平、某一个电池单元的能量水平、某几个电池单元的能量水平、每一个电池单元的能量水平、或者前述能量水平的组合。如前所述,在本实施例中,能量检测单元18检测代表了电池包的能量水平的电池包整包电压,并将其发送给控制模块10。
步骤S1之后,进入步骤S2,控制模块10判断通过能量检测单元18获取的电源模块14的能量水平是否低于第一预设能量水平。该第一预设能量水平预存储在控制模块10的存储器24中,控制模块10的处理器22将该第一预设能量水平和检测到的电源模块14的能量水平进行比较,若电源模块14的能量水平低于第一预设能量水平,则进入步骤S6。步骤S6中,控制模块10控制自动行走设备启动回归。若电源模块14的能量水平不低于第一预设能量水平,则进入步骤S3。如前所述,本实施例中,由于电源模块14的能量水平使用电池包整包电压来表示,存储器24中存储的为一个第一预设电压值,而处理器22也通过比较电池包整包电压和所述第一预设电压值的大小关系,来判断第一预设能量水平和检测到的电源模块14的能量水平的大小关系。虽然在本实施例中,当电源模块14的能量水平等于第一预设能量水平时流程返回步骤S3,但此时流程若进入步骤S6也是可行的。
步骤S3中,控制模块10控制工作模块16启动工作,从而执行相应的工作,如吸尘或割草工作。步骤S3之后,进入步骤S4。步骤S4中执行与步骤S1相同的工作,控制模块10通过能量检测单元18监测电源模块14的能量水平即电池包整包电压。
步骤S4之后,进入步骤S5,控制模块10判断电源模块14的能量水平是否低于第二预设能量水平。该第二预设能量水平预存储在控制模块10的存储器24中,控制模块10的处理器22将该第二预设能量水平和检测到的电源模块14的能量水平进行比较,若电源模块14的能量水平不低于所述第二预设能量水平,则回到步骤S3,自动行走设备2继续工作,不进行其他动作;反之,若电源模块14的能量水平低于所述第二预设能量水平,则进入步骤S6,启动使自动行走设备返回充电站的动作。本实施例中,由于电源模块14的能量水平使用电池包的电压来表示,存储器24中存储的为一个第二预设电压值,而处理器22也通过比较电池包的电压值和所述第二预设电压值的大小关系,来判断第二预设能量水平和检测到的电源模块14的能量水平的大小关系。虽然在本实施例中,当电源模块14的能量水平等于第二预设能量水平时流程返回步骤S3,但此时流程若进入步骤S6也是可行的。
如前所述,控制模块10的存储器24中,分别存储了第一预设能量水平和第二预设能量水平。其中,第一预设能量水平为,自动行走设备的工作模块16执行工作之前,控制模块10判断是否控制自动行走设备启动回归的条件;第二预设能量水平为,自动行走设备的工作模块16执行工作过程中,控制模块10判断是否控制自动行走设备启动回归的条件。第一预设能量水平与第二预设能量水平可以相同,也可以不相同。若为相同时,控制模块10的存储器24仅需存储一个预设能量水平即可,此情形下,在步骤S2及步骤S5中,被用作与检测到的电源模块14的能量水平进行比较的第一预设能量水平和第二预设能量水平为同一个预设能量水平。优选的,第一预设能量水平和第二预设能量水平不相同,更为优选的,控制模块10的存储器24根据电源模块14负载水平的不同存储第一预设能量水平和第二预设能量水平。由于处理器22将电源模块14的能量水平与第一预设能量水平进行比较时,工作模块16尚未开始执行工作,自动行走设备对电源模块14的耗能较少,电源模块14的负载水平小;而处理器22将电源模块14的能量水平与第二预设能量水平进行比较时,工作模块16已开始执行工作,自动行走设备对电源模块14的耗能较多,电源模块14的负载水平大,因此控制模块10的存储器24存储的第一预设能量水平不高于第二预设能量水平。在对第一预设能量水平和第二预设能量水平进行设定时,需要考虑电源模块14剩余的能量水平是否足以支撑自动行走设备回归到充电站。本实施方式中,自动行走设备回归到充电站所需的能量约为100mAh左右,但为提高可靠性,设定第一预设能量水平和第二预设能量水平时保留电源模块14的剩余能量为200mAh。本实施方式中电源模块14为额定电压为28V,容量为2000mAh的锂电电池包,且通过电池包的整包电压反应电源模块14的能量水平。根据实验得知,剩余容量为200mAh,且电池包没有被施加负载时,电池包整包电压为24.5V左右;剩余容量为200mAh,且施加0.6A左右的负载时,电池包整包电压为23V左右。因此控制器的存储器24分别存储两个数值不同的第一预设电压值和第二预设电压值,其中第一预设电压为24.5V,第二预设电压为23V。由此可知,本实施方式中,第一预设电压值和第二预设电压值均为固定值,且第一预设电压值低于第二预设电压值。
前述步骤S0至步骤S5描述了,自动行走设备2判断是否启动回归的方式为,判断电源模块14的能量水平是否低于预设能量水平。除通过前述方式外,还可以通过接收用户回归指令的方式来启动回归,如通过在自动行走设备2的壳体上,设置用户可操作的强制回归按钮,当用户闭合该强制回归按钮时,控制模块10可以检测到该强制回归按钮的状态由断开转为闭合,从而识别到用户强制回归的指令,控制自动行走设备2启动回归。
在控制模块10判断电源模块14的能量水平低于预设能量水平后,为了节约能量,在回归过程中,自动行走设备2通常停止工作模块16的运行。
进入步骤S6后,自动行走设备2启动回归动作,即开始返回充电站4。步骤S6之后为步骤S7。步骤S7中,执行与步骤S1或S4中相同的动作,即控制模块10通过能量检测单元18监测电源模块14的能量水平。
步骤S7之后,自动行走设备2进入步骤S8,控制模块10通过能量检测单元18获取当前电源模块14的能量水平,并根据当前的能量水平计算能量水平的变化率。之所以选择计算能量水平的变化率,是因为经过长期研究和观察发现,电源模块14在放电初期即剩余能量水平较高时,能量水平的变化平缓,而在放电末期即剩余能量水平很低时,能量水平的变化剧烈。该两个阶段中能量水平的变化率具有非常明显的区别,因此只要通过计算能量水平的变化率即可得知电源模块14处于哪一个放电阶段,从而可以得知是否需要停止对电源模块14的进一步放电,防止电源模块14因过放而带来的损害。
为进一步详细说明上述特性,以电源模块14放电过程中电压的变化曲线为例结合如图4进行说明。如图4显示了电源模块14放电过程中,电压对时间的放电曲线,该放电曲线包括A和B两部分,其中A部分的电压缓慢降低,而B部分的电压剧烈降低,且B部分中,电池包在极短的时间电压下降至过放截止电压Umin,若在电压低于Umin仍继续对电源模块14进行放电,则会造成对电源模块14的过放,从而造成电源模块14的损害。由于上述B部分中,电压变化非常明显,因此通过计算变化率并判断变化率是否达到预设门限值即可以得知电池包是否即将接近过放,从而可以对电源模块14进行有效保护。可以通过计算电源模块14的能量水平对时间的一阶导数来计算能量水平的变化率,也可以通过计算电源模块14的能量水平对时间的二阶导数或高阶导数来计算能量水平的变化率,其中二阶导数和高阶导数相对一阶导数具有更为明显的变化,更容易被检测到,但相应地计算也更为复杂。控制模块10计算电源模块14的能量水平的变化率的方式可以通过硬件实现,也可以通过软件实现。硬件方式如通过微分电路,软件方式如通过计算一段连续的时间间隔Δt内的电池包能量水平的变化Δp,即Δp/Δt;或计算一段连续的时间间隔Δt内Δp/Δt的变化,即d2p/d2t;或计算一段连续的时间间隔Δt内d2p/d2t的变化等。本实施方式中,电源模块14的能量水平的变化率通过计算电源模块14的能量水平对时间的一阶导数来获得。由于本实施方式中电源模块14的能量水平为电池包整包电压,电源模块14的能量水平的变化率即为电池包整包电压对时间的一阶导数。控制模块10通过能量检测单元18实时获得电池包整包电压值,并存储在存储器24中。处理器22从存储器24中获取第一特定时间点上的电池包整包电压值及预设时间间隔Δt后的第二特定时间点上的电池包整包电压值,并计算该两个特定时间点上的电压差值ΔV,然后计算ΔV与Δt的比值即ΔV/Δt,由此获得电源模块14的能量水平对时间的一阶导数即能量水平的变化率。此外,当电源模块14的能量水平以电源模块14的放电电流、放电温度等表示时,在加载特定的负载的情况下,放电电流对时间的曲线与图4所示的电压对时间的曲线类似;在保证特定的放电电流的情况下,放电温度对时间的曲线与与图4所示的电压对时间的曲线类似。因此,当能量水平以放电电流、放电温度等参数表示时,也可以通过计算能量水平的变化率确定停止对电源模块14继续放电的时间点,实现对电源模块14的保护。
步骤S8之后,进入步骤S9,自动行走设备2为电源模块14的能量水平的变化率设定一个预设门限值。如图4所示,电源模块14的能量水平随工作时间的延长会出现A和B两个阶段的变化,其中A阶段平缓,B阶段剧烈。但对B阶段变化的剧烈程度,有多个参数会产生影响,如电源模块14的类型、负载水平、放电温度等。当B阶段变化剧烈程度不同时,在需要停止放电的时间点上对应的能量水平的变化率必然不同,因此根据对B阶段变化剧烈程度产生影响的参数,对预设门限值进行设定,能更精确地确定需要停止放电的时间点,更好地对电源模块进行保护。若自动行走设备存在应用不同类型的电源模块14为其提供能量的可能,则在设定预设门限值时,优选为根据不同类型的电源模块14设定不同的预设门限值;反之,若自动行走设备仅应用一种类型的电源模块14为其提供能量,则在设定预设门限值时无需根据不同类型的电源模块14设定不同的预设门限值。此外,若自动行走设备在回归充电站的过程中,电源模块14的负载水平波动较大时,优选为根据不同的负载水平设定不同的预设门限值;若自动行走设备在回归充电站的过程中,电源模块14的负载水平波动较小,则无需根据负载水平设定不同的预设门限值;无论电源模块14的类型是否不同或负载水平波动大小,优选地,根据电源模块14的放电温度设定预设门限值。当然,若自动行走设备仅使用一种化学类型的电源模块14供电,且回归过程中电源模块14的负载水平变化较小;或者虽然自动行走设备使用不同类型电源模块14供电和/或回归过程中电源模块14负载水平波动大,但为使工作流程简便,预设门限值也可以是固定的预设值,即在自动行走设备2出厂时,预设门限值即被设定,而在自动行走设备2工作过程中,不会根据电源模块14的负载水平、类型、放电温度的改变而进行调整。当预设门限值为固定值时,步骤S8可以被免除,即步骤S7之后,执行步骤S9,无需设置步骤S8。
在本实施方式中,控制模块10根据电源模块14的类型、负载水平及放电温度设定预设门限值。具体地,控制模块10通过负载检测单元26检测电池包的放电电流,本实施方式中为0.6A至1A。同时通过类型标识单元28检测电池包的类型,本实施方式中为锂电池。此外,控制模块10还通过温度检测单元检测电源模块14的温度,温度检测单元的工作方式为本领域技术人员所熟知,为简便起见,图示中未示出。在获知电池包的放电电流、放电温度及类型后,通过实时查询存储在存储器24中的门限值表来设定预设门限值0.02V/S。
由于在本实施方式中,负载检测单元26检测的是电源模块14的放电电流,而放电电流也可以是电源模块14的能量水平的表示参数,当能量水平通过放电电流表示且能量检测单元18设置为可以检测电源模块14的放电电流时,负载检测单元26的功能也可以直接由能量检测单元18实现。此外,优选地,温度检测单元的功能也可以直接由能量检测单元18完成。
步骤S9之后,自动行走设备2进入步骤S10,即驱动自动行走设备2向充电站4行走,以便回归到充电站2。自动行走设备2通过引导信号感应单元20寻找和充电站4位置相关的引导信号,并根据引导信号向充电站4行走。如前所述的,引导信号感应单元20通过感应周围由充电引导线6上的电信号产生的磁场信号,向充电引导线6行走,随后沿充电引导线6朝充电站行走。
在执行步骤S10后,进入步骤S12,控制模块10判断自动行走设备2是否成功回归到充电站4,具体为判断自动行走设备2的充电端子是否和充电站4的电源端子对接上。通常,该判断通过监测所述的充电端子上是否接受到了外部的电压或信号来实现,然而该判断也可由其他如位置、碰撞传感器等其他方式来进行。若判断结果为是,自动行走设备2回归到了充电站4,则进入步骤S14,控制模块10控制自动行走设备2停止行走,并开始充电。若判断结果为否,则进入步骤S16。
步骤S16判断电池包的能量水平的变化率的绝对值是否达到或超过预设门限值。若步骤16判断的结果为否,即电池包的能量水平的变化率的绝对值低于预设门限值,则返回步骤S10继续执行回归充电站4的动作。若判断结果为是,即电池包的能量水平的变化率达到或超过预设门限值,则进入步骤S18。步骤S18中,自动行走设备2进入停止行走的状态。具体为由控制模块10控制行走模块12停止行走。
在图3所示工作流程中,无论自动行走设备2是否成功地回归到充电站4,它在电池包的能量水平达到或超过预设门限值后,均处于停止行走的状态。即,若自动行走设备2在电池包的能量水平达到或超过预设门限值之前成功回归到了充电站4,则它会在充电站4中处于停止行走的状态并进行充电;若自动行走设备2在电池包的能量水平达到或超过预设门限值时仍没有成功回归到充电站,它也会处于停止行走的状态。这样的工作流程避免了自动行走设备2在无法顺利返回时,仍不断的寻找充电站4,而导致电池包过放损坏。
优选的,在步骤S16的判断结果为是时,控制模块10还控制自动行走设备2发出一个充电提醒信号,以提醒使用者自动行走设备2需要人工协助回归充电站4。该充电提醒信号可以为显示在自动行走设备2的显示面板上的图文信息,也可以为特殊的报警声音信号,还可以为远程无线发送至使用者的其他设备上的信息,如通过电话网络发送到使用者手机上的短消息或其他提醒信息等。
通过如上所述的工作流程,自动行走设备2能够在开机,或者工作中根据电池包的能量水平适时启动回归,并且在回归过程中对电池包进行过放保护。
虽然在描述本流程的各步骤时,采取了有时间先后的描述方式,该先后的描述方式并不代表每个步骤之间必须遵循严格的顺序,而是根据需要可以进行适当的调整,如步骤S8可以设置在步骤S9之后;步骤S10也可以位于步骤S6与步骤S7之间等。即基于本发明的原理,本领域技术人员可以对本流程中的步骤进行适当的调整,均可实现本发明的效果。
本发明除适用于回归充电站4进行充电的自动行走设备2外,还适用于回归工作站或其它特定装置的自动行走设备2。判断是否回归到工作站或其它特定装置可以通过与判断是否回归到充电站相同的方式实现,也可以通过自动行走设备2达到工作站或其它特定装置的某一特定范围内时,自动行走设备2与工作站或其它特定装置相互发送无线信号进行确认。
Claims (24)
1.一种自动行走设备回归停靠站的控制方法,所述自动行走设备包括提供能量的电源模块,其特征在于,所述控制方法包括如下步骤:
控制自动行走设备启动回归;
检测电源模块的能量水平;
计算电源模块的能量水平的变化率;
当所述能量水平的变化率的绝对值达到或超过预设门限值时,控制自动行走设备停止回归,所述能量水平的变化率为能量水平对时间的一阶导数、二阶导数或高阶导数。
2.根据权利要求1所述的控制方法,其特征在于:所述控制方法还包括设定预设门限值的步骤。
3.根据权利要求2所述的控制方法,其特征在于:根据电源模块的类型、负载水平或放电温度中的至少一个参数,设定预设门限值。
4.根据权利要求1所述的控制方法,其特征在于:所述电源模块的能量水平以电源模块的电压或/和放电电流表示。
5.根据权利要求1所述的控制方法,其特征在于:所述电源模块包括具有至少一个电池单元的电池包,所述电源模块的能量水平为电池包整包的能量水平或电池单元的能量水平中的至少一个。
6.根据权利要求1所述的控制方法,其特征在于:当电源模块的能量水平低于预设能量水平时,控制自动行走设备启动回归。
7.根据权利要求1所述的控制方法,其特征在于:当电源模块的能量水平的变化率的绝对值低于预设门限值时,驱动自动行走设备向停靠站行走。
8.根据权利要求7所述的控制方法,其特征在于:驱动自动行走设备向停靠站行走的过程中,当自动行走设备回归到停靠站时,控制自动行走设备停止回归。
9.根据权利要求7所述的控制方法,其特征在于:所述驱动自动行走设备向停靠站行走的步骤包括:寻找与停靠站位置相关的引导信号;根据引导信号驱动自动行走设备向停靠站行走。
10.根据权利要求9所述的控制方法,其特征在于:所述引导信号为引导线上的电信号,所述引导线连接到停靠站,所述驱动自动行走设备向停靠站行走的步骤具体为:寻找所述电信号;根据所述电信号行走至引导线,驱动自动行走设备沿所述引导线向停靠站行走。
11.根据权利要求1所述的控制方法,其特征在于:所述自动行走设备执行吸尘工作或割草工作。
12.一种自动行走设备,可选择地回归到停靠站,所述自动行走设备包括:
行走模块,驱动自动行走设备行走;
电源模块,为自动行走设备提供能量;
能量检测单元,检测电源模块的能量水平;
控制模块,通过能量检测单元获取当前电源模块的能量水平,并控制行走模块的工作状态,其特征在于:控制模块控制行走模块驱动自动行走设备回归停靠站,控制模块根据当前电源模块的能量水平计算电源模块的能量水平的变化率,当所述能量水平的变化率的绝对值达到或超过预设门限值时,控制模块控制行走模块停止行走,所述能量水平的变化率为能量水平对时间的一阶导数、二阶导数或高阶导数。
13.根据权利要求12所述的自动行走设备,其特征在于:所述控制模块在工作过程中设定所述预设门限值。
14.根据权利要求13所述的自动行走设备,其特征在于:所述自动行走设备还包括标识电源模块类型的类型标识单元,所述控制模块根据所述类型标识单元传递的信号设定所述预设门限值。
15.根据权利要求13所述的自动行走设备,其特征在于:所述自动行走设备还包括检测电源模块的负载水平的负载检测单元,所述控制模块根据负载检测单元传递的信号设定所述预设门限值。
16.根据权利要求13所述的自动行走设备,其特征在于:所述能量检测单元检测电源模块的放电温度,所述控制模块根据能量检测单元传递的信号设定所述预设门限值。
17.根据权利要求12所述的自动行走设备,其特征在于:所述电源模块的能量水平以电源模块的电压或/和放电电流表示。
18.根据权利要求12所述的自动行走设备,其特征在于:所述电源模块包括具有至少一个电池单元的电池包,所述电源模块的能量水平为电池包整包的能量水平或电池单元的能量水平中的至少一个。
19.根据权利要求12所述的自动行走设备,其特征在于:控制模块确认当前电源模块的能量水平低于预设能量水平时,控制行走模块驱动自动行走设备回归停靠站。
20.根据权利要求12所述的自动行走设备,其特征在于:控制模块确认电源模块的能量水平的变化率的绝对值低于预设门限值时,控制行走模块驱动自动行走设备向停靠站行走。
21.根据权利要求20所述的自动行走设备,其特征在于:在自动行走设备向停靠站行走的过程中,控制模块确认自动行走设备回归到停靠站时,控制行走模块停止行走。
22.根据权利要求20所述的自动行走设备,其特征在于:所述自动行走设备还包括引导信号感应单元,所述引导信号感应单元感应与停靠站的位置相关的引导信号,所述控制模块根据引导信号控制行走模块,驱动自动行走设备向停靠站行走。
23.根据权利要求22所述的自动行走设备,其特征在于:所述引导信号为引导线上的电信号,所述引导线连接到停靠站;所述引导信号感应单元感应所述电信号,控制模块根据感应到的电信号,控制行走模块行驶至引导线,沿所述引导线驱动自动行走设备向停靠站行走。
24.根据权利要求12所述的自动行走设备,其特征在于:所述自动行走设备还包括工作模块,所述工作模块执行割草工作或吸尘工作。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210261668.2A CN103576681B (zh) | 2012-07-26 | 2012-07-26 | 自动行走设备及其控制方法 |
EP13754033.2A EP2821874B1 (en) | 2012-03-02 | 2013-02-28 | Automatically travelling device and control method therefor |
US14/382,441 US9440350B2 (en) | 2012-03-02 | 2013-02-28 | Automatically travelling device and control method therefor |
PCT/CN2013/072003 WO2013127350A1 (zh) | 2012-03-02 | 2013-02-28 | 自动行走设备及其控制方法 |
US15/208,899 US10105838B2 (en) | 2012-03-02 | 2016-07-13 | Automatically travelling device and control method therefor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210261668.2A CN103576681B (zh) | 2012-07-26 | 2012-07-26 | 自动行走设备及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103576681A CN103576681A (zh) | 2014-02-12 |
CN103576681B true CN103576681B (zh) | 2017-04-12 |
Family
ID=50048684
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210261668.2A Active CN103576681B (zh) | 2012-03-02 | 2012-07-26 | 自动行走设备及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103576681B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102158695B1 (ko) * | 2014-02-12 | 2020-10-23 | 엘지전자 주식회사 | 로봇 청소기 및 이의 제어방법 |
CN105573311A (zh) * | 2014-10-11 | 2016-05-11 | 苏州宝时得电动工具有限公司 | 自移动机器人 |
CN106142023A (zh) * | 2015-04-24 | 2016-11-23 | 苏州宝时得电动工具有限公司 | 电动工具及电动工具远程信息收集装置、系统和方法 |
CN108142069B (zh) * | 2016-12-02 | 2020-12-11 | 苏州宝时得电动工具有限公司 | 路径移动系统 |
CN107632597B (zh) * | 2016-07-18 | 2020-06-23 | 苏州宝时得电动工具有限公司 | 智能工作系统 |
CN107608341A (zh) * | 2016-07-11 | 2018-01-19 | 苏州宝时得电动工具有限公司 | 自动工作系统及自移动园艺设备的回归控制方法 |
CN109557909B (zh) * | 2017-09-27 | 2022-08-12 | 苏州宝时得电动工具有限公司 | 自行走设备系统、边界线系统及其控制方法 |
WO2021012525A1 (zh) * | 2019-07-24 | 2021-01-28 | 苏州宝时得电动工具有限公司 | 自动行走设备回归停靠站的控制方法及自动行走设备 |
CN112799388A (zh) * | 2019-10-28 | 2021-05-14 | 苏州宝时得电动工具有限公司 | 自移动设备的工作方法及自移动设备 |
CN112462767A (zh) * | 2020-11-24 | 2021-03-09 | 苏州大可机械有限公司 | 检测边界线的断点位置的方法、装置及自行走设备 |
CN214100905U (zh) * | 2020-11-30 | 2021-08-31 | 纳恩博(北京)科技有限公司 | 一种自移动设备充电桩及充电系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2375301A2 (en) * | 2010-03-29 | 2011-10-12 | F. Robotics Acquisitions Ltd. | Robotic element and charging and control system therefor |
CN102463900A (zh) * | 2010-11-14 | 2012-05-23 | 孙善骏 | 移动电磁充电电动汽车 |
CN102480156A (zh) * | 2010-11-30 | 2012-05-30 | 苏州宝时得电动工具有限公司 | 对接方法 |
CN102475015A (zh) * | 2010-11-30 | 2012-05-30 | 苏州宝时得电动工具有限公司 | 自动行走设备 |
CN102508170A (zh) * | 2011-11-09 | 2012-06-20 | 丁国营 | 一种蓄电池容量监测方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7133746B2 (en) * | 2003-07-11 | 2006-11-07 | F Robotics Acquistions, Ltd. | Autonomous machine for docking with a docking station and method for docking |
CN101425678B (zh) * | 2007-10-30 | 2011-11-23 | 比亚迪股份有限公司 | 电池保护方法和系统 |
-
2012
- 2012-07-26 CN CN201210261668.2A patent/CN103576681B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2375301A2 (en) * | 2010-03-29 | 2011-10-12 | F. Robotics Acquisitions Ltd. | Robotic element and charging and control system therefor |
CN102463900A (zh) * | 2010-11-14 | 2012-05-23 | 孙善骏 | 移动电磁充电电动汽车 |
CN102480156A (zh) * | 2010-11-30 | 2012-05-30 | 苏州宝时得电动工具有限公司 | 对接方法 |
CN102475015A (zh) * | 2010-11-30 | 2012-05-30 | 苏州宝时得电动工具有限公司 | 自动行走设备 |
CN102508170A (zh) * | 2011-11-09 | 2012-06-20 | 丁国营 | 一种蓄电池容量监测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103576681A (zh) | 2014-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103576681B (zh) | 自动行走设备及其控制方法 | |
US10105838B2 (en) | Automatically travelling device and control method therefor | |
CN103283404B (zh) | 自动行走设备及其控制方法 | |
CN103744425B (zh) | 自动工作设备及其控制方法 | |
EP3605265A1 (en) | Robotic element and charging and control systems therefor | |
CN103425132A (zh) | 无人行驶作业系统 | |
CN106185151A (zh) | 一种智能仓储系统 | |
CN103728931A (zh) | 自动行走设备远程监控系统及其远程监控方法 | |
CN106171248A (zh) | 智能割草机及其控制方法 | |
CN102880175A (zh) | 自动行走设备 | |
CN206560387U (zh) | 料理机 | |
CN109768602A (zh) | 一种园林工具的电池包充放电方法及系统 | |
KR20130015457A (ko) | 잔디 깎기용 이동로봇 및 이의 제어방법 | |
CN103294056A (zh) | 自动行走设备及其控制方法 | |
CN101826744B (zh) | 铁电池充电电路 | |
WO2019144916A1 (zh) | 自移动设备及其控制方法 | |
CN106468920A (zh) | 回归充电方法及其自动行走设备 | |
CN206818261U (zh) | 移动式雷达波测流装置 | |
CN104798540A (zh) | 电池供电割草机 | |
CN113050620A (zh) | 自驱动设备系统及其边界线断线检测方法 | |
CN108521154B (zh) | 充电方法、洗地机及基于洗地机的充电系统 | |
CN107548712A (zh) | 一种割草机的充电控制方法及装置 | |
CN108631373B (zh) | 对接充电系统 | |
CN106292651A (zh) | 自动工作系统、自动工作设备及其识别出发位置的方法 | |
CN109673240B (zh) | 一种智能割草机 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |