CN111248814A - 一种扫地机器人沿墙运动控制方法 - Google Patents

一种扫地机器人沿墙运动控制方法 Download PDF

Info

Publication number
CN111248814A
CN111248814A CN202010046806.XA CN202010046806A CN111248814A CN 111248814 A CN111248814 A CN 111248814A CN 202010046806 A CN202010046806 A CN 202010046806A CN 111248814 A CN111248814 A CN 111248814A
Authority
CN
China
Prior art keywords
wall
control unit
main control
sweeping robot
pid
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.)
Granted
Application number
CN202010046806.XA
Other languages
English (en)
Other versions
CN111248814B (zh
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 CN202010046806.XA priority Critical patent/CN111248814B/zh
Publication of CN111248814A publication Critical patent/CN111248814A/zh
Application granted granted Critical
Publication of CN111248814B publication Critical patent/CN111248814B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/24—Floor-sweeping machines, motor-driven
    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
    • A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
    • A47L11/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A—HUMAN NECESSITIES
    • A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection

Landscapes

  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种扫地机器人，包括扫地机本体和设置于扫地机本体前端的前挡，所述扫地机本体左右两侧中至少一侧设置有一用于探测墙面的沿墙传感器，所述前挡对应沿墙传感器开设有探测口，所述沿墙传感器包括红外发射源和红外接收器，所述红外发射源的发射基准线与红外接收器的接收基准线之间的夹角呈角度A设置，其中20°<A<40°,所述夹角的角平分线与扫地机器人前进方向垂直，所述红外发射源的发射基准线与红外接收器的接收基准线存在一交点，所述交点与前挡距离为L,其中L<1cm，本发明具备以下有益效果：成本低；可快速调整机身与墙体方向平行；沿墙传感器布置结构优化合理；自动适应各种反光性能不同的墙体；对动态障碍及干扰具有良好的适应性。

Description

一种扫地机器人沿墙运动控制方法
技术领域
本发明涉及扫地机器人技术领域，具体为一种扫地机器人沿墙运动控制方法。
背景技术
目前扫地机器人沿墙清扫路径规划方法存在以下缺陷：(1)在通过碰撞传感器(前挡)探测墙体到进入沿墙行走的过程中，需要进行多次碰撞，产生大量噪音，严重影响用户体验且使碰撞传感器寿命快速降低，导致整机可靠性降低；(2)沿墙行走时对墙体要求较高，目前大多数技术无法探测瓷砖、金属等镜面材质；(3)沿墙距离不稳定，其距离取决于沿墙红外信号阀值的设定，不同墙体由于反光性不同导致沿墙距离忽远忽近，造成清扫覆盖率低下；(4)沿墙行走时无法处理动态障碍，例如来自人、宠物或其他扫地机的干扰。
发明内容
(一)解决的技术问题
针对现有技术的不足，本发明提供了一种扫地机器人沿墙运动控制方法，解决了现有市面上出售的扫地机器人由于其使用的算法导致行走过程中需要多次碰撞导致对墙体要求较高、沿墙距离不稳定、无法处理动态障碍、寿命和可靠性较低以及用户体验感差的问题。
(二)技术方案
为实现以上目的，本发明通过以下技术方案予以实现：一种扫地机器人，包括扫地机本体和设置于扫地机本体前端的前挡，所述扫地机本体左右两侧中至少一侧设置有一用于探测墙面的沿墙传感器，所述前挡对应沿墙传感器开设有探测口，所述沿墙传感器包括红外发射源和红外接收器，所述红外发射源的发射基准线与红外接收器的接收基准线之间的夹角呈角度A设置，其中20°<A<40°,所述夹角的角平分线与扫地机器人前进方向垂直，所述红外发射源的发射基准线与红外接收器的接收基准线存在一交点，所述交点与前挡距离为L,其中L<1cm。
优选的，所述扫地机器人沿墙前进时，所述夹角的角平分线与被探测墙面垂直，且所述交点位于扫地机本体与被探测墙面之间。
优选的，所述L<5mm。
优选的，所述扫地机本体左右两侧均设置有沿墙传感器。
一种扫地机器人沿墙运动控制方法，包括如权利要求1-4任意一项所述的一种扫地机器人，所述扫地机本体内还设置有主控单元、PID稳定控制单元以及PID距离控制单元，所述前挡内设置有碰撞传感器，所述PID稳定控制单元、PID距离控制单元以及碰撞传感器均电性连接主控单元：
步骤1：开启扫地机器人，设定最小沿墙信号值MIN_IR和最大沿墙信号值MAX_IR，主控单元执行沿墙程序，驱动扫地机器人沿墙直线行走，沿墙传感器实时将沿墙信号值IR发送至主控单元；
步骤2：主控单元对实时接收到的沿墙信号值IR与最大沿墙信号值MAX_IR进行对比分析，选取最大值作为最大沿墙信号值MAX_IR，并取最大沿墙信号值MAX_IR的60％-80％作为目标信号值；
步骤3：主控单元计算出实时接收的沿墙信号值IR与上一次接收的沿墙信号值LAST_IR的差值，记为ERR_IR，发送至PID稳定控制单元，并同步计算出实时接收的沿墙信号值IR与目标信号值的差值，记为TRG_ERR_IR,发送至PID距离控制单元；
步骤4：PID稳定控制单元接收到ERR_IR后计算出稳定轮速差DV1，并反馈至主控单元，PID距离控制单元接收到TRG_ERR_IR后计算出距离轮速差DV2并同步反馈至主控单元；
步骤5：主控单元根据反馈结果计算出轮速差DV，并根据轮速差DV控制左、右驱动轮的轮速，调整扫地机器人的行进姿态以及扫地机器人与被探测墙面之间的距离。
步骤6：扫地机器人行走期间，若碰撞传感器发送碰撞信号至主控单元，主控单元则执行内转程序或避障程序，否则保持直行。
优选的，所述PID稳定控制单元接收到ERR_IR以及PID距离控制单元接收到TRG_ERR_IR后，均先通过公式COF＝Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)计算出速度差值COF，式中，Kp为比例控制权重，Ki为积分控制权重，Kd为微分控制权重，ΔSn为本次输入值，ΔSn-1为上一次的输入值；
再通过公式
Figure BDA0002369709600000031
进行限幅运算，得出稳定轮速差DV1或距离轮速差DV2，式中，MaxSpeedDif为最大可设置的速度差，MAX_IR为采集到的最大信号，MaxIntegrate为设定的积分限制。
优选的，所述主控单元接收到PID稳定控制单元发送的DV1以及PID距离控制单元发送的DV2后，对MAX_IR与设定的动态权重临界点进行对比分析：
若MAX_IR>动态权重临界点，主控单元根据公式DV＝DV1×a+DV2×b,a＝0.15,b＝0.85计算出轮速差DV，否则主控单元根据公式DV＝DV1×a+DV2×b,a＝0.9,b＝0.1计算出轮速差DV；
主控单元设置远离被探测墙面的驱动轮轮速为可设置的最大轮速，另一驱动轮轮速为远离被探测墙面的驱动轮轮速和轮速差DV的差值。
优选的，所述主控单元执行内转程序时，将MAX_IR重置为0，并驱动扫地机器人朝沿墙方式相同方向转动，并检测是否有碰撞，若有碰撞则执行避障程序，若无碰撞，则继续转动直至发生碰撞。
优选的，所述主控单元执行避障程序，将MAX_IR重置为0，驱动扫地机器人后退一定距离，朝沿墙方式相反方向转动，转动期间，主控单元对实时接收的沿墙信号值IR进行判断分析，若MAX_IR>IR≥MIN_IR,主控单元执行沿墙程序，否则驱动扫地机器人继续转动。
优选的，所述主控单元执行沿墙程序，将MAX_IR重置为0，并通过PID稳定控制单元和PID距离控制单元控制扫地机器人沿墙运动，并检测是否有碰撞，若有碰撞则执行避障程序，否则主控单元对实时接收的沿墙信号值IR进行分析判断，若IR<MIN_IR或(LAST_IR-IR)/LAST_IR<0.5或IR/LAST_IR<0.2，则执行内转程序，否则继续前进。
(三)有益效果
本发明提供了一种基于PID控制算法的扫地机器人沿线行走控制系统及其控制方法。具备以下有益效果：
(1)成本低，对内存依赖极小，可在STM32F0x0芯片中与其他扫地机器人算法一同流畅运行；
(2)可通过1次碰撞完成墙体探测，快速调整机身与墙体方向平行；
(3)沿墙传感器布置结构优化合理；
(4)可在一次沿墙运动中根据不同墙体反光强度动态调整控制参考量，自动适应各种反光性能不同的墙体；
(5)使用PID距离控制单元控制沿墙距离，并在沿墙运动过程中进行绕圈判断，从而对动态障碍及干扰具有良好的适应性。
附图说明
图1为本发明的扫地机本体硬件结构示意图；
图2为本发明的沿墙传感器结构示意图；
图3为本发明的扫地机本体外观结构示意图；
图4为本发明的沿墙工作状态切换流程框图；
图5为本发明的双PID动态权重沿墙运动控制流程框图。
图中，1扫地机本体、2沿墙传感器、3前挡、4红外接收器、5红外发射源、6探测口。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图1-5，本发明实施例提供一种技术方案，一种扫地机器人，包括扫地机本体1和设置于扫地机本体1前端的前挡3，前挡3呈半圆弧形设置，半径略大于扫地机本体1的半径，罩设于扫地机本体1前端，所述扫地机本体1左右两侧中至少一侧设置有一用于探测墙面的沿墙传感器2，所述前挡3对应沿墙传感器2开设有探测口6，使得红外发射源5发射的红外线能够不被遮挡的照射在被探测的墙面上，并返回被红外接收器4接收，所述沿墙传感器2包括红外发射源5和红外接收器4，所述红外发射源5的发射基准线与红外接收器4的接收基准线之间的夹角呈角度A设置，其中20°<A<40°,所述夹角的角平分线与扫地机器人前进方向垂直，所述红外发射源5的发射基准线与红外接收器4的接收基准线存在一交点，所述交点与前挡3距离为L,其中L<1cm。
所述扫地机器人沿墙前进时，所述夹角的角平分线与被探测墙面垂直，且所述交点位于扫地机本体1与被探测墙面之间。
所述L<5mm。
所述扫地机本体1左右两侧均设置有沿墙传感器2，即该扫地机器人能够进行左沿墙行走(扫地机本体1左边靠墙进行直线行走)和右沿墙行走(扫地机本体1右边靠墙进行直线行走)。
本发明还提供一种扫地机器人沿墙运动控制方法，包括如权利要求1-4任意一项所述的一种扫地机器人，所述扫地机本体1内还设置有主控单元、PID稳定控制单元(稳定性优先的PID控制单元)以及PID距离控制单元(沿墙距离有限的PID控制单元)，所述前挡3内设置有用于检测碰撞的碰撞传感器，所述PID稳定控制单元、PID距离控制单元以及碰撞传感器均电性连接主控单元：
步骤1：开启扫地机器人，设定最小沿墙信号值MIN_IR和最大沿墙信号值MAX_IR，主控单元执行沿墙程序，驱动扫地机器人沿墙直线行走，沿墙传感器2实时将沿墙信号值IR发送至主控单元；
步骤2：主控单元对实时接收到的沿墙信号值IR与最大沿墙信号值MAX_IR进行对比分析，选取最大值作为最大沿墙信号值MAX_IR，并取最大沿墙信号值MAX_IR的60％-80％作为目标信号值；
步骤3：主控单元计算出实时接收的沿墙信号值IR与上一次接收的沿墙信号值LAST_IR的差值，记为ERR_IR，发送至PID稳定控制单元，并同步计算出实时接收的沿墙信号值IR与目标信号值的差值，记为TRG_ERR_IR,发送至PID距离控制单元；
步骤4：PID稳定控制单元接收到ERR_IR后计算出稳定轮速差DV1，并反馈至主控单元，PID距离控制单元接收到TRG_ERR_IR后计算出距离轮速差DV2并同步反馈至主控单元；
步骤5：主控单元根据反馈结果计算出轮速差DV，并根据轮速差DV控制左、右驱动轮的轮速，调整扫地机器人的行进姿态以及扫地机器人与被探测墙面之间的距离。
步骤6：扫地机器人行走期间，若碰撞传感器发送碰撞信号至主控单元，主控单元则执行内转程序或避障程序，否则保持直行。
所述PID稳定控制单元接收到ERR_IR以及PID距离控制单元接收到TRG_ERR_IR后，均先通过公式COF＝Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)计算出速度差值COF，式中，Kp为比例控制权重，Ki为积分控制权重，Kd为微分控制权重，ΔSn为本次输入值，ΔSn-1为上一次的输入值；
再通过公式
Figure BDA0002369709600000081
进行限幅运算，得出稳定轮速差DV1或距离轮速差DV2，式中，MaxSpeedDif为最大可设置的速度差，MAX_IR为采集到的最大信号，MaxIntegrate为设定的积分限制。
所述主控单元接收到PID稳定控制单元发送的DV1以及PID距离控制单元发送的DV2后，对MAX_IR与设定的动态权重临界点进行对比分析：
若MAX_IR>动态权重临界点，主控单元根据公式DV＝DV1×a+DV2×b,a＝0.15,b＝0.85计算出轮速差DV，否则主控单元根据公式DV＝DV1×a+DV2×b,a＝0.9,b＝0.1计算出轮速差DV；
主控单元设置远离被探测墙面的驱动轮轮速为可设置的最大轮速，另一驱动轮轮速为远离被探测墙面的驱动轮轮速和轮速差DV的差值。
所述主控单元执行内转程序时，将MAX_IR重置为0，并驱动扫地机器人朝沿墙方式相同方向转动，并检测是否有碰撞，若有碰撞则执行避障程序，若无碰撞，则继续转动直至发生碰撞。
所述主控单元执行避障程序，将MAX_IR重置为0，驱动扫地机器人后退一定距离，朝沿墙方式相反方向转动，转动期间，主控单元对实时接收的沿墙信号值IR进行判断分析，若MAX_IR>IR≥MIN_IR,主控单元执行沿墙程序，否则驱动扫地机器人继续转动。
所述主控单元执行沿墙程序，将MAX_IR重置为0，并通过PID稳定控制单元和PID距离控制单元控制扫地机器人沿墙运动，并检测是否有碰撞，若有碰撞则执行避障程序，否则主控单元对实时接收的沿墙信号值IR进行分析判断，若IR<MIN_IR或(LAST_IR-IR)/LAST_IR<0.5或IR/LAST_IR<0.2，则执行内转程序，否则继续前进。
实施例1
步骤1：开启扫地机器人，设定最小沿墙信号值MIN_IR和最大沿墙信号值MAX_IR，开启扫地机器人，扫地机器人进行一次碰撞检测判断，若主控单元未接收碰撞信号，则进入初始状态，即沿当前方向向前直线行走，否则主控单元执行避障程序，初始状态等同于主控单元执行沿墙程序，驱动扫地机器人沿墙直线行走，沿墙传感器2实时(每一毫秒)将沿墙信号值IR发送至主控单元(若左沿墙则取左侧沿墙传感器信号值，若右沿墙则取右侧沿墙传感器信号值)；
步骤2：主控单元对实时接收到的沿墙信号值IR与最大沿墙信号值MAX_IR进行对比分析，选取两者中的最大值作为最大沿墙信号值MAX_IR实时更新，并取最大沿墙信号值MAX_IR的80％作为目标信号值；
步骤3：主控单元计算出实时接收的沿墙信号值IR与上一次接收的沿墙信号值LAST_IR的差值，记为ERR_IR，ERR_IR＝LAST_IR-IR,发送至PID稳定控制单元，并同步计算出实时接收的沿墙信号值IR与目标信号值的差值，记为TRG_ERR_IR,TRG_ERR_IR＝MAX_IR×80％-IR,发送至PID距离控制单元；
步骤4：PID稳定控制单元接收到ERR_IR后通过公式COF＝Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)计算出速度差值COF，式中，Kp为比例控制权重(Kp＝1)，Ki为积分控制权重(Ki＝0.9)，Kd为微分控制权重(Kd＝0.07)，ΔSn为本次输入值即ERR_IR，ΔSn-1为上一次的输入值即上一次输入的ERR_IR，再通过公式
Figure BDA0002369709600000101
进行限幅运算(由于计算出的速度差值COF可能大于可设置的最大速度差)，得出稳定轮速差DV1，式中，MaxSpeedDif为最大可设置的速度差，MAX_IR为采集到的最大信号，MaxIntegrate为设定的积分限制，并反馈至主控单元，PID距离控制单元接收到TRG_ERR_IR后通过公式COF＝Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)计算出速度差值COF，式中，Kp为比例控制权重(Kp＝0.6)，Ki为积分控制权重(Ki＝-0.01)，Kd为微分控制权重(Kd＝6)，ΔSn为本次输入值即TRG_ERR_IR，ΔSn-1为上一次的输入值即上一次输入的TRG_ERR_IR，再通过公式
Figure BDA0002369709600000111
进行限幅运算(由于计算出的速度差值COF可能大于可设置的最大速度差)，得出稳定轮速差DV2并同步反馈至主控单元；
步骤5：主控单元接收反馈结果即PID稳定控制单元反馈的DV1和PID距离控制单元反馈的DV2后，对MAX_IR与设定的动态权重临界点(主控单元根据扫地机器人信号自动设定，动态权重临界点的取值范围为80-400，本实施例取160)进行对比分析，若MAX_IR>动态权重临界点，主控单元根据公式DV＝DV1×a+DV2×b,a＝0.15,b＝0.85计算出轮速差DV，否则主控单元根据公式DV＝DV1×a+DV2×b,a＝0.9,b＝0.1计算出轮速差DV，并根据轮速差DV控制左、右驱动轮的轮速即主控单元设置远离被探测墙面的驱动轮轮速(转向时位于外侧的驱动轮)为可设置的最大轮速，另一驱动轮(转向时位于内侧的驱动轮)轮速为远离被探测墙面的驱动轮轮速和轮速差DV的差值，调整扫地机器人的行进姿态(使得夹角的角平分线与被探测墙面垂直)以及扫地机器人与被探测墙面之间的距离不超过5mm。
步骤6：扫地机器人行走期间，若碰撞传感器发送碰撞信号至主控单元，主控单元则执行内转程序或避障程序，否则保持直行：
所述主控单元执行内转程序时，将MAX_IR重置为0，并驱动扫地机器人朝沿墙方式相同方向(左沿墙方式朝左转，右沿墙方式向右转)转动，并检测是否有碰撞，若有碰撞则执行避障程序，若无碰撞，则继续转动直至发生碰撞。
所述主控单元执行避障程序，将MAX_IR重置为0，驱动扫地机器人后退一定距离，朝沿墙方式相反方向转动(左沿墙方式朝右转，右沿墙方式朝左转)，转动期间，主控单元对实时接收的沿墙信号值IR进行判断分析，若MAX_IR>IR≥MIN_IR,主控单元执行沿墙程序，否则驱动扫地机器人继续转动。
所述主控单元执行沿墙程序，将MAX_IR重置为0，并通过PID稳定控制单元和PID距离控制单元控制扫地机器人沿墙运动，并检测是否有碰撞，若有碰撞则执行避障程序，否则主控单元对实时接收的沿墙信号值IR进行分析判断，若IR<MIN_IR或(LAST_IR-IR)/LAST_IR<0.5或IR/LAST_IR<0.2，则执行内转程序，否则继续前进。
扫地机器人在沿墙行走的过程中，其工作状态可概括为初始状态、避障状态、沿墙状态以及内转状态，且四种工作状态如上步骤进行转化(请参阅图4)，并且其一直处于运行之中。
由于扫地机器人离墙体越远，沿墙红外信号越弱，故ERR_I大于0则表明机器正在远离墙，反之ERR_IR小于0则表明扫地机器人正在靠近墙，故使用ERR_IR作为输入的PID稳定控制单元会使机器前进方向稳定于墙体平行线。由于目标沿墙信号为MAX_IR的80％，MAX_IR根据墙体的反射性能决定，TRG_ERR_IR大于0则表明扫地机器人与被探测墙面之间的距离大于目标沿墙距离，小于0则表明扫地机器人过于接近被探测墙面，故使用TRG_ERR_IR作为输入的PID距离控制单元会使扫地机器人离墙距离尽可能小，两个PID控制单元根据动态权重临界点切换权重，可以使机器在高反光的墙体和低反光的墙体两种不同墙体上选择控制偏重，使沿墙算法能适应各种墙体。
需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。
尽管已经示出和描述了本发明的实施例，对于本领域的普通技术人员而言，可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由所附权利要求及其等同物限定。

Claims (10)

1.一种扫地机器人，包括扫地机本体和设置于扫地机本体前端的前挡，其特征在于，所述扫地机本体左右两侧中至少一侧设置有一用于探测墙面的沿墙传感器，所述前挡对应沿墙传感器开设有探测口，所述沿墙传感器包括红外发射源和红外接收器，所述红外发射源的发射基准线与红外接收器的接收基准线之间的夹角呈角度A设置，其中20°<A<40°,所述夹角的角平分线与扫地机器人前进方向垂直，所述红外发射源的发射基准线与红外接收器的接收基准线存在一交点，所述交点与前挡距离为L,其中L<1cm。
2.根据权利要求1所述的一种扫地机器人，其特征在于，所述扫地机器人沿墙前进时，所述夹角的角平分线与被探测墙面垂直，且所述交点位于扫地机本体与被探测墙面之间。
3.根据权利要求1所述的一种扫地机器人，其特征在于，所述L<5mm。
4.根据权利要求1所述的一种扫地机器人，其特征在于，所述扫地机本体左右两侧均设置有沿墙传感器。
5.一种扫地机器人沿墙运动控制方法，其特征在于，包括如权利要求1-4任意一项所述的一种扫地机器人，所述扫地机本体内还设置有主控单元、PID稳定控制单元以及PID距离控制单元，所述前挡内设置有碰撞传感器，所述PID稳定控制单元、PID距离控制单元以及碰撞传感器均电性连接主控单元：
步骤1：开启扫地机器人，设定最小沿墙信号值MIN_IR和最大沿墙信号值MAX_IR，主控单元执行沿墙程序，驱动扫地机器人沿墙直线行走，沿墙传感器实时将沿墙信号值IR发送至主控单元；
步骤2：主控单元对实时接收到的沿墙信号值IR与最大沿墙信号值MAX_IR进行对比分析，选取最大值作为最大沿墙信号值MAX_IR，并取最大沿墙信号值MAX_IR的60％-80％作为目标信号值；
步骤3：主控单元计算出实时接收的沿墙信号值IR与上一次接收的沿墙信号值LAST_IR的差值，记为ERR_IR，发送至PID稳定控制单元，并同步计算出实时接收的沿墙信号值IR与目标信号值的差值，记为TRG_ERR_IR,发送至PID距离控制单元；
步骤4：PID稳定控制单元接收到ERR_IR后计算出稳定轮速差DV1，并反馈至主控单元，PID距离控制单元接收到TRG_ERR_IR后计算出距离轮速差DV2并同步反馈至主控单元；
步骤5：主控单元根据反馈结果计算出轮速差DV，并根据轮速差DV控制左、右驱动轮的轮速，调整扫地机器人的行进姿态以及扫地机器人与被探测墙面之间的距离。
步骤6：扫地机器人行走期间，若碰撞传感器发送碰撞信号至主控单元，主控单元则执行内转程序或避障程序，否则保持直行。
6.根据权利要求5所述的一种扫地机器人沿墙运动控制方法，其特征在于，所述PID稳定控制单元接收到ERR_IR以及PID距离控制单元接收到TRG_ERR_IR后，均先通过公式COF＝Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)计算出速度差值COF，式中，Kp为比例控制权重，Ki为积分控制权重，Kd为微分控制权重，ΔSn为本次输入值，ΔSn-1为上一次的输入值；
再通过公式
Figure FDA0002369709590000031
进行限幅运算，得出稳定轮速差DV1或距离轮速差DV2，式中，MaxSpeedDif为最大可设置的速度差，MAX_IR为采集到的最大信号，MaxIntegrate为设定的积分限制。
7.根据权利要求5所述的一种扫地机器人沿墙运动控制方法，其特征在于，所述主控单元接收到PID稳定控制单元发送的DV1以及PID距离控制单元发送的DV2后，对MAX_IR与设定的动态权重临界点进行对比分析：
若MAX_IR>动态权重临界点，主控单元根据公式DV＝DV1×a+DV2×b,a＝0.15,b＝0.85计算出轮速差DV，否则主控单元根据公式DV＝DV1×a+DV2×b,a＝0.9,b＝0.1计算出轮速差DV；
主控单元设置远离被探测墙面的驱动轮轮速为可设置的最大轮速，另一驱动轮轮速为远离被探测墙面的驱动轮轮速和轮速差DV的差值。
8.根据权利要求5所述的一种扫地机器人沿墙运动控制方法，其特征在于，所述主控单元执行内转程序时，将MAX_IR重置为0，并驱动扫地机器人朝沿墙方式相同方向转动，并检测是否有碰撞，若有碰撞则执行避障程序，若无碰撞，则继续转动直至发生碰撞。
9.根据权利要求8所述的一种扫地机器人沿墙运动控制方法，其特征在于，所述主控单元执行避障程序，将MAX_IR重置为0，驱动扫地机器人后退一定距离，朝沿墙方式相反方向转动，转动期间，主控单元对实时接收的沿墙信号值IR进行判断分析，若MAX_IR>IR≥MIN_IR,主控单元执行沿墙程序，否则驱动扫地机器人继续转动。
10.根据权利要求9所述的一种扫地机器人沿墙运动控制方法，其特征在于，所述主控单元执行沿墙程序，将MAX_IR重置为0，并通过PID稳定控制单元和PID距离控制单元控制扫地机器人沿墙运动，并检测是否有碰撞，若有碰撞则执行避障程序，否则主控单元对实时接收的沿墙信号值IR进行分析判断，若IR<MIN_IR或(LAST_IR-IR)/LAST_IR<0.5或IR/LAST_IR<0.2，则执行内转程序，否则继续前进。
CN202010046806.XA 2020-01-16 2020-01-16 一种扫地机器人沿墙运动控制方法 Active CN111248814B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010046806.XA CN111248814B (zh) 2020-01-16 2020-01-16 一种扫地机器人沿墙运动控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010046806.XA CN111248814B (zh) 2020-01-16 2020-01-16 一种扫地机器人沿墙运动控制方法

Publications (2)

Publication Number Publication Date
CN111248814A true CN111248814A (zh) 2020-06-09
CN111248814B CN111248814B (zh) 2021-07-13

Family

ID=70943963

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010046806.XA Active CN111248814B (zh) 2020-01-16 2020-01-16 一种扫地机器人沿墙运动控制方法

Country Status (1)

Country Link
CN (1) CN111248814B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112386177A (zh) * 2020-11-04 2021-02-23 深圳市云视机器人有限公司 清洁设备运动控制方法、存储介质及清洁设备
CN112698657A (zh) * 2020-12-28 2021-04-23 湖南格兰博智能科技有限责任公司 一种扫地机器人路径规划方法
CN113208510A (zh) * 2021-05-13 2021-08-06 深圳市云视机器人有限公司 可沿墙的扫地机器人装置
CN113934209A (zh) * 2021-09-29 2022-01-14 深圳甲壳虫智能有限公司 一种机器人及机器人周围障碍物探测方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4890103A (en) * 1985-04-30 1989-12-26 Tokyo Aircraft Instrument Co., Ltd. Rate-of-climb indicator
CN2847224Y (zh) * 2005-06-22 2006-12-13 王冬雷 一种智能悬崖和墙壁检测装置及其机器人
CN1959435A (zh) * 2006-09-14 2007-05-09 喻礼琼 一种全自动吸尘器的多传感器障碍物检测装置
CN203338058U (zh) * 2013-07-09 2013-12-11 常熟理工学院 一种远程控制的爬墙机器人
CN103529832A (zh) * 2013-09-24 2014-01-22 苏州工业园区职业技术学院 基于双核四轮高速微电脑鼠对角线冲刺系统
CN104821754A (zh) * 2015-05-22 2015-08-05 中国科学院自动化研究所 智能墙面抹灰机器人的专用控制器
CN105573321A (zh) * 2016-01-05 2016-05-11 国家电网公司 一种基于激光轨道的变电站巡检机器人导航方法
KR101643193B1 (ko) * 2015-04-17 2016-07-27 한화탈레스 주식회사 질량 이동을 이용한 수중 운동체
CN105843251A (zh) * 2016-03-28 2016-08-10 沈阳上博智拓科技有限公司 控制飞行器的方法、装置及系统
KR20160133035A (ko) * 2015-05-11 2016-11-22 (주)동명기술공단종합건축사사무소 수질 자동 측정기의 위치조절장치
CN108968815A (zh) * 2018-06-29 2018-12-11 炬大科技有限公司 一种扫地机器人障碍判定并沿边行走装置及方法
CN110680243A (zh) * 2019-09-30 2020-01-14 湖南格兰博智能科技有限责任公司 一种扫地机器人沿墙清扫控制算法

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4890103A (en) * 1985-04-30 1989-12-26 Tokyo Aircraft Instrument Co., Ltd. Rate-of-climb indicator
CN2847224Y (zh) * 2005-06-22 2006-12-13 王冬雷 一种智能悬崖和墙壁检测装置及其机器人
CN1959435A (zh) * 2006-09-14 2007-05-09 喻礼琼 一种全自动吸尘器的多传感器障碍物检测装置
CN203338058U (zh) * 2013-07-09 2013-12-11 常熟理工学院 一种远程控制的爬墙机器人
CN103529832A (zh) * 2013-09-24 2014-01-22 苏州工业园区职业技术学院 基于双核四轮高速微电脑鼠对角线冲刺系统
KR101643193B1 (ko) * 2015-04-17 2016-07-27 한화탈레스 주식회사 질량 이동을 이용한 수중 운동체
KR20160133035A (ko) * 2015-05-11 2016-11-22 (주)동명기술공단종합건축사사무소 수질 자동 측정기의 위치조절장치
CN104821754A (zh) * 2015-05-22 2015-08-05 中国科学院自动化研究所 智能墙面抹灰机器人的专用控制器
CN105573321A (zh) * 2016-01-05 2016-05-11 国家电网公司 一种基于激光轨道的变电站巡检机器人导航方法
CN105843251A (zh) * 2016-03-28 2016-08-10 沈阳上博智拓科技有限公司 控制飞行器的方法、装置及系统
CN108968815A (zh) * 2018-06-29 2018-12-11 炬大科技有限公司 一种扫地机器人障碍判定并沿边行走装置及方法
CN110680243A (zh) * 2019-09-30 2020-01-14 湖南格兰博智能科技有限责任公司 一种扫地机器人沿墙清扫控制算法

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112386177A (zh) * 2020-11-04 2021-02-23 深圳市云视机器人有限公司 清洁设备运动控制方法、存储介质及清洁设备
CN112698657A (zh) * 2020-12-28 2021-04-23 湖南格兰博智能科技有限责任公司 一种扫地机器人路径规划方法
CN113208510A (zh) * 2021-05-13 2021-08-06 深圳市云视机器人有限公司 可沿墙的扫地机器人装置
CN113208510B (zh) * 2021-05-13 2022-04-15 深圳市云视机器人有限公司 可沿墙的扫地机器人装置
CN113934209A (zh) * 2021-09-29 2022-01-14 深圳甲壳虫智能有限公司 一种机器人及机器人周围障碍物探测方法
CN113934209B (zh) * 2021-09-29 2024-01-16 深圳甲壳虫智能有限公司 一种机器人及机器人周围障碍物探测方法

Also Published As

Publication number Publication date
CN111248814B (zh) 2021-07-13

Similar Documents

Publication Publication Date Title
CN111248814B (zh) 一种扫地机器人沿墙运动控制方法
CN110680243B (zh) 一种扫地机器人沿墙清扫控制算法
JP6976701B2 (ja) カバレッジロボットナビゲーション
AU2015207833B2 (en) Steer control maneuvers for materials handling vehicles
EP1936464B1 (en) Robot cleaner system and control method thereof
JP6549033B2 (ja) 自律移動地面処理ロボット、及びその清掃作業の制御方法
EP2325714B1 (en) Control method of performing rotational traveling of robot cleaner
CN107997689B (zh) 扫地机器人和扫地机器人的避障方法及装置
CA2827735A1 (en) Object tracking and steer maneuvers for materials handling vehicles
CN110554696A (zh) 机器人系统、机器人及基于激光雷达的机器人导航方法
JP2019113926A (ja) モデル予測制御装置
WO2024113261A1 (zh) 机器人及其避障方法，机器人系统及存储介质
WO2022022227A1 (zh) 一种距离检测装置及扫地机器人
CN110088701B (zh) 用于自走式清洁设备的运行方法以及这种清洁设备
CN112904845A (zh) 基于无线测距传感器的机器人卡住检测方法、系统及芯片
JP6415642B1 (ja) 衝突回避装置
KR20090019479A (ko) 로봇 청소기의 장애물 감지 방법 및 이에 적합한 로봇청소기
JP2017111771A (ja) 自律走行車両、自律走行システム及び自律走行車両の制御方法
AU2014268191B2 (en) Object tracking and steer maneuvers for materials handling vehicles
CN111123956A (zh) 避障装置、控制方法、沿边控制方法及测距系统
CN114879663A (zh) 一种机器人控制方法、芯片以及机器人
CN112965082B (zh) 一种基于激光雷达的自适应沿墙导航方法
CN113440049B (zh) 一种清洁机器人及其控制方法
JPH05184489A (ja) 自走式掃除機
CN112748724B (zh) 一种接收充电座护栏信号后的控制方法、芯片及机器人

Legal Events

Date Code Title Description
PB01 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