[go: up one dir, main page]

CN104188600A - 一种应用于自动地面清洁机装置的碰撞检测的方法及装置 - Google Patents

一种应用于自动地面清洁机装置的碰撞检测的方法及装置 Download PDF

Info

Publication number
CN104188600A
CN104188600A CN201410469344.7A CN201410469344A CN104188600A CN 104188600 A CN104188600 A CN 104188600A CN 201410469344 A CN201410469344 A CN 201410469344A CN 104188600 A CN104188600 A CN 104188600A
Authority
CN
China
Prior art keywords
cleaning machine
floor cleaning
machine device
automatic floor
propulsion
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.)
Pending
Application number
CN201410469344.7A
Other languages
English (en)
Inventor
陈海初
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
HUNAN GRAND-PRO ROBOT TECHNOLOGY Co Ltd
Original Assignee
HUNAN GRAND-PRO ROBOT TECHNOLOGY Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by HUNAN GRAND-PRO ROBOT TECHNOLOGY Co Ltd filed Critical HUNAN GRAND-PRO ROBOT TECHNOLOGY Co Ltd
Priority to CN201410469344.7A priority Critical patent/CN104188600A/zh
Publication of CN104188600A publication Critical patent/CN104188600A/zh
Pending legal-status Critical Current

Links

Landscapes

  • Electric Vacuum Cleaner (AREA)

Abstract

本发明涉及一种应用于自动地面清洁机装置的碰撞检测方法及装置,当自动地面清洁机装置开始正常稳定工作时所述控制单元监测并记录所述当前推进马达的电流值I1;此后,所述控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值I2,并计算I2与I1的差值ΔI;比较预先设定的阈值Ia与ΔI大小;如果ΔI大于或等于Ia,则判断所述自动地面清洁机装置的推进单元当前遇到了较大阻力,控制单元控制推进单元的两个推进马达的方向及速度,转变移动方向;如果ΔI小于Ia,则继续按照原方向移动执行清洁工作。该方式结构简单,节约了成本,经济效果好。

Description

一种应用于自动地面清洁机装置的碰撞检测的方法及装置
技术领域
本发明涉及一种检测装置,特别涉及一种应用于自动地面清洁机装置的碰撞检测方法及装置。
背景技术
随着家用设备的高度自动化及数字化的趋势,现有手动吸尘器已渐渐不为人们所使用,自动地面清洁机装置(robotic floor cleaner),因其具有完全自动化清洁家居地板而大幅节省人力的优点,同时归功其制造成本不断下降,已逐渐普及至一般家庭生活中。
 现有的自动地面清洁机装置对碰撞障碍物的检测手段大致可以分为两种:
    一种是装置前部设有碰撞感应保险杆,保险杆有一定活动范围,并设有一复位弹簧,用以缓冲碰撞,保险杆连接有光电开关,当保险杆发生一定幅度的位移,光电开关就会检测到遮挡信号,遮挡信号传递至控制电路,装置启动转向程序。
 另一种是装置前部设有红外检测模块,该模块具有检测前方障碍物距离的功能,当距离小于某设定值时,装置发生转向。
以上两钟方法各有缺点:第一种方法由于采用的结构比较复杂,生产加工成本较高,故障率也高,在实际使用过程中,相互关联的几个环节只要有一个环节出现问题,将导致自动地面清洁机装置无法正常运行,比较常见的故障是保险杆卡死无法复位等;第二种方法的明显缺陷是此类自动地面清洁机装置需智能识别床裙与障碍物,由于床裙同样具有反射红外线的功能,所以自动地面清洁机装置误以为床裙也是障碍物,从而执行转向程序。这样,床底下的灰尘将无法清除到。再则此类自动地面清洁机装置所用的红外检测模块同样存在成本较高的问题。
发明内容
本发明所要解决的技术问题是提供一种应用于自动地面清洁机装置的基于电流强度检测碰撞的检测方法,同时本发明还提供一种应用于自动地面清洁机装置的基于电流强度检测碰撞的检测装置。
为解决上述问题,本发明提供的技术方案如下:
    一种应用于自动地面清洁机装置的碰撞检测的方法,其特征在于:包括如下步骤:
第一步,启动自动地面清洁机装置;
第二步,监测并记录所述自动地面清洁机装置开始正常稳定工作时当前推进马达的电流值I1;
第三步,实时监测所述自动地面清洁机装置推进马达的电流值I2;
第四步,计算I2与I1的差值ΔI;
第五步,比较预先设定的阈值Ia与ΔI大小;
    如果ΔI大于或等于Ia,判定所述自动地面清洁机装置发生了碰撞,推进单元当前遇到了较大阻力,则所述自动地面清洁机装置执行转向程序转变移动方向;
    如果ΔI小于Ia,继续按照原移动方向执行清洁工作;
第六步,如果尚未完成清洁任务则转入第三步,否则停机结束清洁任务。
进一步地,第五步所述的阈值Ia为200mA。
进一步地,述第二步和第三步是通过监测推进马达的输入端电流值来监测自动地面清洁机装置推进马达的电流值。
一种应用于自动地面清洁机装置的碰撞检测的装置,包括一本体,所述本体包括使本体在地面移动的推进单元,用以控制推进单元使本体自动依一预定模式在地面移动的控制单元,所述推进单元设有两个推进马达,控制单元分别控制推进单元的两个推进马达的方向及速度,以此实现对自动地面清洁机装置的推进、转向或退后,其特征在于:
当自动地面清洁机装置开始正常稳定工作时所述控制单元监测并记录所述当前推进马达的电流值I1;此后,所述控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值I2,并计算I2与I1的差值ΔI;比较预先设定的阈值Ia与ΔI大小;如果ΔI大于或等于Ia,则判定所述自动地面清洁机装置的推进单元当前发生了碰撞,遇到了较大阻力,控制单元控制推进单元的两个推进马达的方向及速度,转变移动方向;如果ΔI小于Ia,则继续按照原方向移动执行清洁工作。
    进一步地,所述控制单元设置有MCU处理器,用于监测推进单元的两个推进马达的当前电流值。
进一步地,所述控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值是推进马达输入端的电流值。
与现有的技术相比,基于电流强度检测自动地面清洁机装置碰撞的检测方法,误判及出错的概率低,可以有效实现对碰撞的检测。且通过控制单元时刻检测推进单元推进马达的电流实现对自动地面清洁机装置碰撞检测的装置,无需增加新额外的零部件,这种方式结构简单,节约了成本,经济效果良好。且检测电路与电机驱动电路电气隔离,避免了对原驱动电路电气属性的破坏,也不会将电机驱动电路的干扰引入检测电路。
附图说明
图1是本发明自动地面清洁机装置的障碍检测流程图。
图2是本发明自动地面清洁机装置的结构示意图。
具体实施方式
为了更充分地公开本发明,下面结合附图对本发明技术方案进行详细说明。
本发明的技术原理为,当自动地面清洁机装置碰到了障碍物时,推进马达的驱动电流的会突然增大以抵消障碍物带来的阻力,通过比较自动地面清洁机装置此时的电流与正常工作时的电流的差值与预先设定阈值的大小可以判断是否碰到了障碍物。
    如图1所示, 一种应用于自动地面清洁机装置的碰撞检测的方法,其特征在于:包括如下步骤:
第一步,启动自动地面清洁机装置;
第二步,监测并记录所述自动地面清洁机装置开始正常稳定工作时当前推进马达的电流值I1;
第三步,实时监测所述自动地面清洁机装置推进马达的电流值I2;
第四步,计算I2与I1的差值ΔI;
第五步,比较预先设定的阈值Ia与ΔI大小;
    如果ΔI大于或等于Ia,判定所述自动地面清洁机装置发生了碰撞,推进单元当前遇到了较大阻力,则所述自动地面清洁机装置执行转向程序转变移动方向;
    如果ΔI小于Ia,继续按照原移动方向执行清洁工作;
第六步,如果尚未完成清洁任务则转入第三步,否则停机结束清洁任务。
前述第五步所述的阈值Ia为200mA。
前述第二步和第三步是通过监测推进马达的输入端电流值来监测自动地面清洁机装置推进马达的电流值。
前述差值ΔI是I2减I1的值。
用于实现前述方法的一种应用于自动地面清洁机装置的碰撞检测的装置,包括一本体,所述本体包括使本体在地面移动的推进单元,用以控制推进单元使本体自动依一预定模式在地面移动的控制单元,所述推进单元设有两个推进马达,控制单元分别控制推进单元的两个推进马达的方向及速度,以此实现对自动地面清洁机装置的推进、转向或退后,其特征在于:
当自动地面清洁机装置开始正常稳定工作时所述控制单元监测并记录所述当前推进马达的电流值I1;此后,所述控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值I2,并计算I2与I1的差值ΔI;比较预先设定的阈值Ia与ΔI大小;如果ΔI大于或等于Ia,则判定所述自动地面清洁机装置的推进单元当前发生了碰撞,遇到了较大阻力,控制单元控制推进单元的两个推进马达的方向及速度,转变移动方向;如果ΔI小于Ia,则继续按照原方向移动执行清洁工作。
前述的控制单元设置有MCU处理器,负责监测推进单元的两个推进马达的当前电流值。
前述的控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值是推进马达输入端的电流值。
具体实施例:
如图2所示,一种自动地面清洁机装置包括本体1,以及设置于本体1内的推进单元2、吸尘单元4、掠扫单元5和控制单元3。所述推进单元2设有两个推进马达,控制单元3分别控制推进单元的两个推进马达的方向及速度,以此实现对自动地面清洁机装置的推进、转向或退后。控制单元3时刻监测推进马达的运动状态,记录推进马达的当前电压值,电流值。
控制单元3设置有MCU处理器,负责监测推进单元2的两个推进马达的当前电压值和电流值。如图1所示,当自动地面清洁机装置开始正常稳定工作后,亦即自动地面清洁机装置开始移动并执行清扫工作2至10秒时,控制单元3的MCU处理器记录当前推进马达输入端的电流值I1。控制单元3的MCU处理器记录当前推进马达的电流值I2,并计算I1与I2的差值ΔI。差值ΔI是I2减I1的值,因为在发生碰撞时,必然是I2的值大于I1的值。当遇到障碍物或者从瓷砖地面移动到木质地面时,自动地面清洁机装置的运动状态发生变化,推进单元2的推进马达的电流变化。通过大量实践实验得出,自动地面清洁机装置正常工作时差值ΔI为小于200mA,而当遇到障碍物并与之相撞,推进马达的电流会瞬间增大以抵消阻力,因此此时ΔI会大于200mA。程序预先设定有一阈值Ia为200mA,通过实时计算ΔI并比较ΔI与Ia的大小,判断自动地面清洁机装置当前的运动状态。当ΔI大于或等于Ia,程序判断自动地面清洁机装置的推进单元当前发生了碰撞,执行转向程序。而当ΔI小于Ia但ΔI不为0时,判断自动地面清洁机装置可能到达了不同摩擦力的地面,不转向,继续按原方向执行清洁工作。同样的ΔI为0时也不转向,继续按原方向执行清洁工作。

Claims (6)

1.一种应用于自动地面清洁机装置的碰撞检测的方法,其特征在于:包括如下步骤:
第一步,启动自动地面清洁机装置;
第二步,监测并记录所述自动地面清洁机装置开始正常稳定工作时当前推进马达的电流值I1;
第三步,实时监测所述自动地面清洁机装置推进马达的电流值I2;
第四步,计算I2与I1的差值ΔI;
第五步,比较预先设定的阈值Ia与ΔI大小;
如果ΔI大于或等于Ia,判定所述自动地面清洁机装置发生了碰撞,推进单元当前遇到了较大阻力,则所述自动地面清洁机装置执行转向程序转变移动方向;
如果ΔI小于Ia,继续按照原移动方向执行清洁工作;
第六步,如果尚未完成清洁任务则转入第三步,否则停机结束清洁任务。
2.根据权利要求1所述的自动地面清洁机装置的碰撞检测的方法,其特征在于:第五步所述的阈值Ia为200mA。
3.根据权利要求1所述的自动地面清洁机装置的碰撞检测的方法,其特征在于:所述第二步和第三步是通过监测推进马达的输入端电流值来监测自动地面清洁机装置推进马达的电流值。
4.一种应用于自动地面清洁机装置的碰撞检测的装置,包括一本体,所述本体包括使本体在地面移动的推进单元,用以控制推进单元使本体自动依一预定模式在地面移动的控制单元,所述推进单元设有两个推进马达,控制单元分别控制推进单元的两个推进马达的方向及速度,以此实现对自动地面清洁机装置的推进、转向或退后,其特征在于:
当自动地面清洁机装置开始正常稳定工作时所述控制单元监测并记录所述当前推进马达的电流值I1;此后,所述控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值I2,并计算I2与I1的差值ΔI;比较预先设定的阈值Ia与ΔI大小;如果ΔI大于或等于Ia,则判断所述自动地面清洁机装置发生了碰撞,推进单元当前遇到了较大阻力,控制单元控制推进单元的两个推进马达的方向及速度,转变移动方向;如果ΔI小于Ia,则继续按照原方向移动执行清洁工作。
5.根据权利要求4所述的应用于自动地面清洁机装置的碰撞检测的装置,其特征在于,所述控制单元设置有MCU处理器,用于监测推进单元的两个推进马达的当前电流值。
6.根据权利要求4所述的应用于自动地面清洁机装置的碰撞检测的装置,其特征在于,所述控制单元时刻监测并记录所述自动地面清洁机装置推进马达的电流值是推进马达输入端的电流值。
CN201410469344.7A 2014-09-16 2014-09-16 一种应用于自动地面清洁机装置的碰撞检测的方法及装置 Pending CN104188600A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410469344.7A CN104188600A (zh) 2014-09-16 2014-09-16 一种应用于自动地面清洁机装置的碰撞检测的方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410469344.7A CN104188600A (zh) 2014-09-16 2014-09-16 一种应用于自动地面清洁机装置的碰撞检测的方法及装置

Publications (1)

Publication Number Publication Date
CN104188600A true CN104188600A (zh) 2014-12-10

Family

ID=52074109

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410469344.7A Pending CN104188600A (zh) 2014-09-16 2014-09-16 一种应用于自动地面清洁机装置的碰撞检测的方法及装置

Country Status (1)

Country Link
CN (1) CN104188600A (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017211151A1 (zh) * 2016-06-06 2017-12-14 北京小米移动软件有限公司 清洁机器人及障碍物跨越方法
CN107962569A (zh) * 2017-11-23 2018-04-27 珠海格力电器股份有限公司 一种机器人的碰撞检测方法、装置及智能机器人
CN109202873A (zh) * 2018-11-22 2019-01-15 北京秘塔网络科技有限公司 一种柔性协作机械臂及其控制方法
CN110073794A (zh) * 2019-04-30 2019-08-02 浙江亚特电器有限公司 用于智能割草机的碰撞检测方法
CN110328664A (zh) * 2019-06-28 2019-10-15 希格斯动力科技(珠海)有限公司 碰撞检测方法及装置
CN111571641A (zh) * 2019-02-15 2020-08-25 速感科技(北京)有限公司 摇杆式碰撞传感装置及自主移动设备
CN112743535A (zh) * 2019-10-30 2021-05-04 北京配天技术有限公司 一种自适应碰撞检测方法、装置以及存储介质
CN112923968A (zh) * 2019-12-06 2021-06-08 纳恩博(北京)科技有限公司 碰撞检测方法、装置、存储介质及电子装置
CN114061424A (zh) * 2022-01-17 2022-02-18 广东奥迪威传感科技股份有限公司 机器人的碰撞定位方法
CN114794980A (zh) * 2022-04-02 2022-07-29 深圳市云鼠科技开发有限公司 一种清扫方法及清洁机器人
CN114947609A (zh) * 2022-05-17 2022-08-30 上海景吾酷租科技发展有限公司 底盘自动回位方法、系统、介质及机器人

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101446832A (zh) * 2007-11-27 2009-06-03 常州新区常工电子计算机有限公司 机器人吸尘器自动避障及其控制方法
CN201840421U (zh) * 2010-08-13 2011-05-25 刘瑜 一种自动吸尘器的电子控制装置
CN102426391A (zh) * 2011-09-05 2012-04-25 华南理工大学 一种判断机器人运行是否发生碰撞的方法
KR20130113726A (ko) * 2012-04-06 2013-10-16 삼성전자주식회사 로봇 청소기 및 그 제어 방법
JP5400966B2 (ja) * 2011-04-28 2014-01-29 株式会社東芝 電気掃除機
US20140075689A1 (en) * 2012-09-19 2014-03-20 Vorwerk & Co. Interholding Gmbh Automatically traveling floor cleaning appliance and method for operating a floor cleaning appliance
CN103976696A (zh) * 2013-02-08 2014-08-13 深圳市恒润晖光电科技有限公司 自走式拖地机

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101446832A (zh) * 2007-11-27 2009-06-03 常州新区常工电子计算机有限公司 机器人吸尘器自动避障及其控制方法
CN201840421U (zh) * 2010-08-13 2011-05-25 刘瑜 一种自动吸尘器的电子控制装置
JP5400966B2 (ja) * 2011-04-28 2014-01-29 株式会社東芝 電気掃除機
CN102426391A (zh) * 2011-09-05 2012-04-25 华南理工大学 一种判断机器人运行是否发生碰撞的方法
KR20130113726A (ko) * 2012-04-06 2013-10-16 삼성전자주식회사 로봇 청소기 및 그 제어 방법
US20140075689A1 (en) * 2012-09-19 2014-03-20 Vorwerk & Co. Interholding Gmbh Automatically traveling floor cleaning appliance and method for operating a floor cleaning appliance
CN103976696A (zh) * 2013-02-08 2014-08-13 深圳市恒润晖光电科技有限公司 自走式拖地机

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EA035938B1 (ru) * 2016-06-06 2020-09-03 Бейдзин Сяоми Мобайл Софтвэр Ко., Лтд. Робот-уборщик и способ преодоления препятствия
WO2017211151A1 (zh) * 2016-06-06 2017-12-14 北京小米移动软件有限公司 清洁机器人及障碍物跨越方法
CN107962569A (zh) * 2017-11-23 2018-04-27 珠海格力电器股份有限公司 一种机器人的碰撞检测方法、装置及智能机器人
CN107962569B (zh) * 2017-11-23 2019-12-10 珠海格力电器股份有限公司 一种机器人的碰撞检测方法、装置及智能机器人
CN109202873A (zh) * 2018-11-22 2019-01-15 北京秘塔网络科技有限公司 一种柔性协作机械臂及其控制方法
CN111571641B (zh) * 2019-02-15 2022-03-01 速感科技(北京)有限公司 摇杆式碰撞传感装置及自主移动设备
CN111571641A (zh) * 2019-02-15 2020-08-25 速感科技(北京)有限公司 摇杆式碰撞传感装置及自主移动设备
CN110073794A (zh) * 2019-04-30 2019-08-02 浙江亚特电器有限公司 用于智能割草机的碰撞检测方法
CN110328664A (zh) * 2019-06-28 2019-10-15 希格斯动力科技(珠海)有限公司 碰撞检测方法及装置
CN112743535A (zh) * 2019-10-30 2021-05-04 北京配天技术有限公司 一种自适应碰撞检测方法、装置以及存储介质
CN112743535B (zh) * 2019-10-30 2024-01-09 北京配天技术有限公司 一种自适应碰撞检测方法、装置以及存储介质
CN112923968A (zh) * 2019-12-06 2021-06-08 纳恩博(北京)科技有限公司 碰撞检测方法、装置、存储介质及电子装置
CN114061424A (zh) * 2022-01-17 2022-02-18 广东奥迪威传感科技股份有限公司 机器人的碰撞定位方法
CN114794980A (zh) * 2022-04-02 2022-07-29 深圳市云鼠科技开发有限公司 一种清扫方法及清洁机器人
CN114794980B (zh) * 2022-04-02 2024-07-23 深圳市云鼠科技开发有限公司 一种清扫方法及清洁机器人
CN114947609A (zh) * 2022-05-17 2022-08-30 上海景吾酷租科技发展有限公司 底盘自动回位方法、系统、介质及机器人
CN114947609B (zh) * 2022-05-17 2024-08-20 上海景吾酷租科技发展有限公司 底盘自动回位方法、系统、介质及机器人

Similar Documents

Publication Publication Date Title
CN104188600A (zh) 一种应用于自动地面清洁机装置的碰撞检测的方法及装置
CN106618386B (zh) 一种清洁机器人
CN110946508B (zh) 使用激光雷达和摄像头的扫地机器人的控制方法及装置
US10678251B2 (en) Cleaning method for a robotic cleaning device
CN101446832B (zh) 机器人吸尘器自动避障控制方法
CN107618033B (zh) 机器人急停控制系统与方法
JP2016520389A (ja) 自走式装置およびその制御方法
CN208988720U (zh) 清洁机器人
CN106953589A (zh) 一种用于光伏清洁机判断真卡死和假卡死的控制方法
CN102591338B (zh) 擦玻璃机器人的控制系统及其控制方法
CN116807297A (zh) 一种清洁机器人的控制方法
CN102591333B (zh) 擦玻璃机器人的控制系统及其控制方法
CN106970625A (zh) 驱动装置及方法
KR102122236B1 (ko) 로봇 청소기 및 로봇 청소기의 제어 방법
CN121421410A (zh) 清洁设备的控制方法
CN112220413A (zh) 一种扫地机器人打滑检测方法、装置及可读存储介质
KR101641244B1 (ko) 로봇 청소기 및 이의 제어 방법
CN102591334B (zh) 擦玻璃机器人的贴边控制系统及其控制方法
CN206085074U (zh) 一种清洁机器人
CN102591337A (zh) 擦玻璃装置的信息交互系统及其方法
CN102599862B (zh) 自动吸尘器困境识别及脱离的方法
KR20110053759A (ko) 로봇 청소기 및 이의 제어 방법
CN205417544U (zh) 一种汽车智能清洁机控制系统
CN204565414U (zh) 一种防盗扣的超声波自动焊接分拣装置
CN107872026A (zh) 一种电动底盘车的逻辑控制方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20141210

RJ01 Rejection of invention patent application after publication