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