CN106970623B - 智能清洁装置及其网格路径作业方法 - Google Patents

智能清洁装置及其网格路径作业方法 Download PDF

Info

Publication number
CN106970623B
CN106970623B CN201710252483.8A CN201710252483A CN106970623B CN 106970623 B CN106970623 B CN 106970623B CN 201710252483 A CN201710252483 A CN 201710252483A CN 106970623 B CN106970623 B CN 106970623B
Authority
CN
China
Prior art keywords
cleaning device
wall
intelligent cleaning
intelligent
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
Application number
CN201710252483.8A
Other languages
English (en)
Other versions
CN106970623A (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.)
Hangzhou Jolog Robot Technology Co ltd
Original Assignee
Hangzhou Jolog 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 Hangzhou Jolog Robot Technology Co ltd filed Critical Hangzhou Jolog Robot Technology Co ltd
Priority to CN201710252483.8A priority Critical patent/CN106970623B/zh
Publication of CN106970623A publication Critical patent/CN106970623A/zh
Application granted granted Critical
Publication of CN106970623B publication Critical patent/CN106970623B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electric Vacuum Cleaner (AREA)
  • Navigation (AREA)

Abstract

本发明提供的智能清洁装置及其网格路径作业方法,包括第一次弓字清扫和第二次弓字清扫、沿墙清扫等不同的清扫模式,陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块完成网格式清扫,既可以可以保证清扫高清扫率,同时减少清扫的重叠率,相比较之前的清扫方法,效果更好。

Description

智能清洁装置及其网格路径作业方法
技术领域
本发明属于智能机器人领域,具体涉及智能清洁装置及其网格路径作业方法。
背景技术
智能清洁装置又称智能吸尘器、扫地机器人等,属于智能家电产品的一种,能凭借一定的人工智能,自动在房间内完成地板清理工作。一般采用刷扫和真空方式,将地面杂物先吸纳进入自身的垃圾收纳盒,从而完成地面清理的功能。
机身为自动化技术的可移动装置,与有集尘盒的真空吸尘装置,配合机身设定控制路径,在室内反复行走,如:沿墙清扫、集中清扫、随机清扫、直线清扫、弓字清扫等路径打扫,并辅以边刷、中央主刷旋转、抹布等方式。
现在市场上的扫地机器人在清扫工作时,普遍没有具体而且合理的线径规划,扫地机器人行走的路径杂乱,尤其在障碍物较多的房间内,扫地机器人要么在障碍物中间来回碰撞迷失,要么为了规避各个障碍物而导致很多区域无法清扫干净,扫地机器人在某一房间清扫工作结束后,不能自动找到房间出口,退出到其他房间进行清扫。市场上的扫地机器人普遍清扫覆盖率低,清扫区域重叠率高,清扫效率低。
发明内容
针对现有技术中存在的问题,本发明提供一种智能清洁装置及其网格路径作业方法,通过两次弓字清扫的路径规划,使其清扫路线呈现为网格形状,可以垂直交错覆盖待清扫待作业空间。
本发明提供的技术方案,具体为:
智能清洁装置的网格路径作业方法,其特征在于,包括以下步骤:
步骤A:将智能清洁装置置于待作业空间,保持智能清洁装置处于开启状态;
步骤B:通过设置在智能清洁装置上的墙体检测模块对墙体的具体位置进行定位,并通过陀螺仪模块多次检测其与墙体的角度,比较连续多次的角度差值,调整智能清洁装置与墙体的角度,其中墙体检测模块包括左墙检、中墙检、右墙检;
步骤C:陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与墙体平行;
步骤D:当智能清洁装置本体与墙体平行时,陀螺仪模块将以智能清洁装置与墙体平行的点为中心坐标(X0,Y0)建立第一坐标系(X,Y),并完成弓字清扫的路径规划;
步骤E:智能清洁装置垂直于第一坐标系中的X轴做第一次弓字清扫;
步骤F:当智能清洁装置完成第一次弓字清扫时,陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与另一面墙体平行,开始沿墙清扫,并记录智能清洁装置与墙体平行的点(X2,Y2);
步骤G:陀螺仪模块以(X2,Y2)为中心坐标建立第二坐标系(X’,Y’),并完成弓字清扫的路径规划;
步骤H:智能清洁装置垂直于第二坐标系的Y1轴做第二次弓字清扫直至智能清洁装置清扫工作完成。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置做第一次弓字清扫、第二次弓字清扫时,智能清洁装置的行走宽度为固定值,行走宽度值在0.1-0.18m之间。
智能清洁装置的网格路径作业方法,其特征在于,所述智能清洁装置的行走宽度为0.15m。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置进行第一次弓字清扫,在X轴的相对位移小于0.15m时,智能清洁装置到达X轴方向上房间的另一面墙体,所述驱动模块控制行走模块做沿墙清扫,并记录此时坐标Xn;
当智能清洁装置进行第二次弓字清扫,在Y’轴的相对位移小于0.15m时,智能清洁装置到达Y’轴方向上房间的另一面墙体,所述驱动模块控制行走模块做沿墙清扫,并记录此时坐标Y’n。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置进行第一次弓字清扫,陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,即判断智能清洁装置在X轴上有回退,智能清洁装置在X轴上的第一次弓字清扫完成;
当智能清洁装置进行第二次弓字清扫,陀螺仪模块检测到智能清洁装置在Y’轴坐标点Y’n-1小于Y’n时,即判断智能清洁装置在Y’轴上有回退,智能清洁装置在Y’轴上的第二次弓字清扫完成。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置完成第一次弓字清扫时,陀螺仪模块通过驱动模块控制行走模块调整智能清洁装置的工作角度,使其与另一面墙体平行,行走模块停转数秒,陀螺仪模块惯导稳定后,开始进行第二次弓字清扫。
智能清洁装置的网格路径作业方法,其特征在于,智能清洁装置做第一次弓字清扫、第二次弓字清扫时,当作业空间的平面内存在障碍物,若只有左墙检或右墙检检测到障碍物,智能清洁装置沿原方向沿墙清扫。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置做沿墙清扫且墙体检测模块无法检测到障碍物时,智能清洁装置继续沿原方向做弓字清扫。
智能清洁装置的网格路径作业方法,其特征在于,当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在X轴的相对位移等于0.15m时,恢复弓字清扫;
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,且陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,结束第一次弓字清扫,继续沿墙清扫。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置进行第二次弓字清扫,左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移等于0.15m时,恢复弓字清扫;
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移小于0.15m时,结束第二次弓字清扫,继续沿墙清扫。
智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
智能清洁装置,其特征在于,包括陀螺仪模块、墙体检测模块、驱动模块、行走模块,所述陀螺仪模块、墙体检测模块、驱动模块、行走模块按照权利要求1-12任一项所述的方法控制所述智能清洁装置对待作业空间进行清扫。
有益效果:
①本发明提供的智能清洁装置及其网格路径作业方法,与单纯的弓字清扫相比,通过两次弓字清扫的网格式路径规划,极大提高智能清洁装置的清扫效率与覆盖率,避免部分区域的清扫不到位和清扫不净。
②本发明提供的智能清洁装置及其网格路径作业方法,针对待作业空间内的障碍物做出沿墙清扫的模式,墙体检测模块无法检测到障碍物时,继续做弓字清扫,解决了障碍物周边垃圾清理难,无法清理干净的问题。
③本发明提供的智能清洁装置及其网格路径作业方法,沿墙清扫于弓字清扫的合理适用解决了待作业空间墙体为不规则形状时清理难的问题,增强了智能清洁装置的产品适用性。
④本发明提供的智能清洁装置及其网格路径作业方法,在完成第一次弓字清扫,智能清洁装置通过陀螺仪模块调整其与另一面墙体的角度直至其与另一面墙体平行时,行走模块停转数秒,陀螺仪模块惯导稳定后,才开始进行第二次弓字清扫,此时重新校准陀螺仪模块能使角度更加精确,解决陀螺仪模块随机器发热而产生的温飘的问题。
附图说明
图1为本发明角度调整路径规划图。
图2为本发明第一次弓字清扫路径规划图A。
图3为本发明第一次弓字清扫路径规划图B。
图4为本发明第二次弓字清扫路径规划图。
图5为本发明沿墙清扫找出口路径规划图。
图6为本发明第一次弓字清扫与第二次弓字清扫路径规划图。
图7为本发明实施例1的第一次弓字清扫与第二次弓字清扫路径规划图。
图8为本发明实施例1的网格路径作业的路径规划图。
图9为本发明实施例2的网格路径作业的路径规划图。
具体实施方式
智能清洁装置的网格路径作业方法,包括以下步骤:
步骤A:将智能清洁装置置于待作业空间,保持智能清洁装置处于开启状态;
步骤B:通过设置在智能清洁装置上的墙体检测模块对墙体的具体位置进行定位,并通过陀螺仪模块多次检测其与墙体的角度,比较连续多次的角度差值,调整智能清洁装置与墙体的角度,其中墙体检测模块包括左墙检、中墙检、右墙检;
步骤C:陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与墙体平行;
步骤D:当智能清洁装置本体与墙体平行时,陀螺仪模块将以智能清洁装置与墙体平行的点为中心坐标(X0,Y0)建立第一坐标系(X,Y),并完成弓字清扫的路径规划;
步骤E:智能清洁装置垂直于第一坐标系中的X轴做第一次弓字清扫;
步骤F:当智能清洁装置完成第一次弓字清扫时,陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与另一面墙体平行,开始沿墙清扫,并记录智能清洁装置与墙体平行的点(X2,Y2);
步骤G:陀螺仪模块以(X2,Y2)为中心坐标建立第二坐标系(X’,Y’),并完成弓字清扫的路径规划;
步骤H:智能清洁装置垂直于第二坐标系的Y1轴做第二次弓字清扫直至智能清洁装置清扫工作完成。
智能清洁装置的网格路径作业方法,当智能清洁装置做第一次弓字清扫、第二次弓字清扫时,智能清洁装置的行走宽度为固定值,行走宽度值在0.1-0.18m之间。
智能清洁装置的网格路径作业方法,智能清洁装置的行走宽度为0.15m。
智能清洁装置的网格路径作业方法,当智能清洁装置进行第一次弓字清扫,在X轴的相对位移小于0.15m时,智能清洁装置到达X轴方向上房间的另一面墙体,驱动模块控制行走模块做沿墙清扫,并记录此时坐标Xn;
当智能清洁装置进行第二次弓字清扫,在Y’轴的相对位移小于0.15m时,智能清洁装置到达Y’轴方向上房间的另一面墙体,驱动模块控制行走模块做沿墙清扫,并记录此时坐标Y’n。
智能清洁装置的网格路径作业方法,当智能清洁装置进行第一次弓字清扫,陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,即判断智能清洁装置在X轴上有回退,智能清洁装置在X轴上的第一次弓字清扫完成;
当智能清洁装置进行第二次弓字清扫,陀螺仪模块检测到智能清洁装置在Y’轴坐标点Y’n-1小于Y’n时,即判断智能清洁装置在Y’轴上有回退,智能清洁装置在Y’轴上的第二次弓字清扫完成。
智能清洁装置的网格路径作业方法,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
智能清洁装置的网格路径作业方法,当智能清洁装置完成第一次弓字清扫时,陀螺仪模块通过驱动模块控制行走模块调整智能清洁装置的工作角度,使其与另一面墙体平行,行走模块停转数秒,陀螺仪模块惯导稳定后,开始进行第二次弓字清扫。
智能清洁装置的网格路径作业方法,智能清洁装置做第一次弓字清扫、第二次弓字清扫时,当作业空间的平面内存在障碍物,若只有左墙检或右墙检检测到障碍物,智能清洁装置沿原方向沿墙清扫。
智能清洁装置的网格路径作业方法,当智能清洁装置做沿墙清扫且墙体检测模块无法检测到障碍物时,智能清洁装置继续沿原方向做弓字清扫。
智能清洁装置的网格路径作业方法,当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在X轴的相对位移等于0.15m时,恢复弓字清扫;
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,且陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,结束第一次弓字清扫,继续沿墙清扫。
智能清洁装置的网格路径作业方法,当智能清洁装置进行第二次弓字清扫,左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移等于0.15m时,恢复弓字清扫;
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移小于0.15m时,结束第二次弓字清扫,继续沿墙清扫。
智能清洁装置的网格路径作业方法,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
智能清洁装置,包括陀螺仪模块、墙体检测模块、驱动模块、行走模块,所述陀螺仪模块、墙体检测模块、驱动模块、行走模块按照权利要求1-12任一项所述的方法控制所述智能清洁装置对待作业空间进行清扫。
下面结合说明书附图对本发明做进一步说明:
参照附图1,将处于开启状态的智能清洁装置置于待作业空间,通过设置在智能清洁装置上的墙体检测模块对墙体的具体位置进行定位,并通过陀螺仪模块检测其与墙体的角度A,当A<90°,继续调整智能清洁装置与墙体的角度B,当A<B<90°时,继续调整智能清洁装置与墙体的角度C,当B<C=90°时,智能清洁装置与墙体平行。
其中墙体检测模块包括左墙检、中墙检、右墙检,墙体检测模块搭载有红外传感器或超声波传感器。
参考附图2,当智能清洁装置本体与墙体平行时,陀螺仪模块将以智能清洁装置与墙体平行的点为中心坐标(X0,Y0)建立第一坐标系(X,Y),智能清洁装置垂直于X轴进行第一次弓字清扫。
当智能清洁装置进第一次弓字清扫时,其沿着X轴的行走宽度是固定值,行走宽度值之间;优选地,行走宽度为0.15m。
参考附图8,当智能清洁装置进行第一次弓字清扫,在X轴的相对位移小于行走宽度S时,智能清洁装置到达X轴方向上房间的另一面墙体,驱动模块控制行走模块做沿墙清扫,并记录此时坐标Xn。
参考附图3,智能清洁装置沿墙清扫,当陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,即判断智能清洁装置在X轴上有回退,智能清洁装置在X轴上的第一次弓字清扫完成。
参考附图4,当第一次弓字清扫完成时,陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与墙体平行,开始沿墙清扫,并记录智能清洁装置与墙体平行的点(X2,Y2),以(X2,Y2)为中心坐标建立第二坐标系(X’,Y’),并完成弓字清扫的路径规划。
智能清洁装置垂直于Y’轴进行第二次弓字清扫。
当智能清洁装置进第二次弓字清扫时,其沿着Y’轴的行走宽度是固定值,行走宽度值在0.1-0.18m之间;优选地,行走宽度为0.15m。
参考附图8,当智能清洁装置进行第二次弓字清扫,在Y’轴的相对位移小于行走宽度L时,智能清洁装置到达Y’轴方向上房间的另一面墙体,驱动模块控制行走模块做沿墙清扫,并记录此时坐标Y’n。
当智能清洁装置进行第二次弓字清扫,陀螺仪模块检测到智能清洁装置在Y’轴坐标点Y’n-1小于Y’n时,即判断智能清洁装置在Y’轴上有回退,智能清洁装置在Y’轴上的第二次弓字清扫完成。
参考附图5,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
参考附图6,智能清洁装置依次完成第一次弓字清扫、第二次弓字清扫后,智能清洁装置的清扫路径在作业空间表面形成网格路径。
当然,除上述相互垂直的网格路径外,两次清扫的弓字清扫路径也可以呈直角以外的角度。
实施例1:参考附图7、8,智能清洁装置做第一次弓字清扫、第二次弓字清扫时,当作业空间的平面内存在障碍物,若只有左墙检或右墙检检测到障碍物,智能清洁装置沿原方向沿墙清扫,见附图8。当智能清洁装置做沿墙清扫且墙体检测模块(包括左墙检、中墙检、右墙检)无法检测到障碍物时,智能清洁装置继续沿原方向做弓字清扫。
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于S,开始沿墙清扫。当陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,第一次弓字清扫结束,继续沿墙清扫。
陀螺仪模块通过驱动模块控制行走模块调整智能清洁装置的工作角度,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与墙体平行,行走模块停转数秒,陀螺仪模块惯导稳定后,因陀螺仪随着发热会有一定的角度温飘,此时重新校准陀螺仪能使角度更加精确,解决温飘的异常。开始进行第二次弓字清扫。
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫。当陀螺仪模块检测到智能清洁装置在Y’轴坐标点Y’n-1小于Y’n时,第二次弓字清扫结束。
驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
实施例2:参考附图9,当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在X轴的相对位移等于0.15m时,恢复弓字清扫;
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,且陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,结束第一次弓字清扫,继续沿墙清扫。
当智能清洁装置进行第二次弓字清扫,左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移等于0.15m时,恢复弓字清扫;
当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移小于0.15m时,结束第二次弓字清扫,继续沿墙清扫。
驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
此外,术语“多个”仅用于描述目的,而不能理解为指标或暗示相对重要性或者隐含指明所指示的技术特征的数量。本发明的描述中,多个的含义是两个或两个以上,除非另有明确具体的限定。
在本发明中,除非另有明确的规定和限定,术语“小于”、“大于”仅用于描述目的,其描述是基于所指装置或元件的特定形状,只是为了便于理解和描述,不能理解为对本发明的限制。
尽管上面已经示出和描述了本发明的实施例,但上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下载本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (9)

1.智能清洁装置的网格路径作业方法,其特征在于,包括以下步骤:
步骤A:将智能清洁装置置于待作业空间,保持智能清洁装置处于开启状态;
步骤B:通过设置在智能清洁装置上的墙体检测模块对墙体的具体位置进行定位,并通过陀螺仪模块多次检测其与墙体的角度,比较连续多次的角度差值,调整智能清洁装置与墙体的角度,其中墙体检测模块包括左墙检、中墙检、右墙检;
步骤C:陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与墙体平行;
步骤D:当智能清洁装置本体与墙体平行时,陀螺仪模块将以智能清洁装置与墙体平行的点为中心坐标(X0,Y0)建立第一坐标系(X,Y),并完成弓字清扫的路径规划;
步骤E:智能清洁装置垂直于第一坐标系中的X轴做第一次弓字清扫;当智能清洁装置在X轴的相对位移小于行走宽度S时,智能清洁装置到达X轴方向上房间的另一面墙体,驱动模块控制行走模块做沿墙清扫,且当判断智能清洁装置在X轴上有回退时,智能清洁装置在X轴上的第一次弓字清扫完成;其中,当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在X轴的相对位移等于0.15m时,恢复弓字清扫;
陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,即判断智能清洁装置在X轴上有回退,智能清洁装置在X轴上的第一次弓字清扫完成;其中,当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在X轴的相对位移小于0.15m,开始沿墙清扫,且陀螺仪模块检测到智能清洁装置在X轴坐标点Xn-1小于Xn时,结束第一次弓字清扫,继续沿墙清扫;
步骤F:当智能清洁装置完成第一次弓字清扫时,陀螺仪模块将智能清洁装置与墙体的角度信号传输给驱动模块,驱动模块控制行走模块调整智能清洁装置与墙体的角度直到智能清洁装置与另一面墙体平行,开始沿墙清扫,并记录智能清洁装置与墙体平行的点(X2,Y2);
步骤G:陀螺仪模块以(X2,Y2)为中心坐标建立第二坐标系(X’,Y’),并完成弓字清扫的路径规划;
步骤H:智能清洁装置垂直于第二坐标系的Y’轴做第二次弓字清扫直至智能清洁装置清扫工作完成,其中,当智能清洁装置进行第二次弓字清扫,左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移等于0.15m时,恢复弓字清扫;
陀螺仪模块检测到智能清洁装置在Y’轴坐标点Y’n-1小于Y’n时,即判断智能清洁装置在Y’轴上有回退,智能清洁装置在Y’轴上的第二次弓字清扫完成;其中,当左墙检、中墙检、右墙检都检测到障碍物,且其转弯后在Y’轴的相对位移小于0.15m,开始沿墙清扫,当沿墙清扫在Y’轴的相对位移小于0.15m时,结束第二次弓字清扫,继续沿墙清扫;
在上述步骤中,当智能清洁装置做第一次弓字清扫、第二次弓字清扫时,智能清洁装置的行走宽度为固定值,行走宽度值在0.1-0.18m之间。
2.根据权利要求1所述的智能清洁装置的网格路径作业方法,其特征在于,所述智能清洁装置的行走宽度为0.15m。
3.根据权利要求2所述的智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置进行第一次弓字清扫,在X轴的相对位移小于0.15m时,智能清洁装置到达X轴方向上房间的另一面墙体,所述驱动模块控制行走模块做沿墙清扫,并记录此时坐标Xn;
当智能清洁装置进行第二次弓字清扫,在Y’轴的相对位移小于0.15m时,智能清洁装置到达Y’轴方向上房间的另一面墙体,所述驱动模块控制行走模块做沿墙清扫,并记录此时坐标Y’n。
4.根据权利要求3所述的智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
5.根据权利要求1或3所述的智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置完成第一次弓字清扫时,陀螺仪模块通过驱动模块控制行走模块调整智能清洁装置的工作角度,使其与另一面墙体平行,行走模块停转数秒,陀螺仪模块惯导稳定后,开始进行第二次弓字清扫。
6.根据权利要求1或3所述的智能清洁装置的网格路径作业方法,其特征在于,智能清洁装置做第一次弓字清扫、第二次弓字清扫时,当作业空间的平面内存在障碍物,若只有左墙检或右墙检检测到障碍物,智能清洁装置沿原方向沿墙清扫。
7.根据权利要求6所述的智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置做沿墙清扫且墙体检测模块无法检测到障碍物时,智能清洁装置继续沿原方向做弓字清扫。
8.根据权利要求1所述的智能清洁装置的网格路径作业方法,其特征在于,当智能清洁装置完成第二次弓字清扫时,驱动模块控制智能清洁装置沿墙清扫,寻找出口,直至找到出口并退出当前作业空间。
9.智能清洁装置,其特征在于,包括陀螺仪模块、墙体检测模块、驱动模块、行走模块,所述陀螺仪模块、墙体检测模块、驱动模块、行走模块按照权利要求1-8任一项所述的方法控制所述智能清洁装置对待作业空间进行清扫。
CN201710252483.8A 2017-04-18 2017-04-18 智能清洁装置及其网格路径作业方法 Active CN106970623B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710252483.8A CN106970623B (zh) 2017-04-18 2017-04-18 智能清洁装置及其网格路径作业方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710252483.8A CN106970623B (zh) 2017-04-18 2017-04-18 智能清洁装置及其网格路径作业方法

Publications (2)

Publication Number Publication Date
CN106970623A CN106970623A (zh) 2017-07-21
CN106970623B true CN106970623B (zh) 2021-05-25

Family

ID=59334071

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710252483.8A Active CN106970623B (zh) 2017-04-18 2017-04-18 智能清洁装置及其网格路径作业方法

Country Status (1)

Country Link
CN (1) CN106970623B (zh)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109388093B (zh) * 2017-08-02 2020-09-15 苏州珊口智能科技有限公司 基于线特征识别的机器人姿态控制方法、系统及机器人
CN107807650A (zh) * 2017-11-29 2018-03-16 莱克电气股份有限公司 一种机器人的运动控制方法、装置及设备
CN108873889A (zh) * 2018-05-14 2018-11-23 北京石头世纪科技有限公司 智能移动设备及其路径控制方法、计算机可读存储介质
CN108592923A (zh) * 2018-06-05 2018-09-28 北京智行者科技有限公司 一种作业路径规划方法
JP2020039455A (ja) * 2018-09-07 2020-03-19 日立グローバルライフソリューションズ株式会社 電気掃除機
CN111345734B (zh) * 2018-12-24 2021-11-09 珠海市一微半导体有限公司 扫地机器人作业方法、装置、存储介质及扫地机器人
CN109528101A (zh) * 2019-01-04 2019-03-29 云鲸智能科技(东莞)有限公司 移动机器人的转弯方法、移动机器人及存储介质
CN110432834A (zh) * 2019-07-02 2019-11-12 上海岚豹智能科技有限公司 一种扫地机的清扫方法和扫地机
CN111067430B (zh) * 2019-12-27 2022-08-19 美智纵横科技有限责任公司 清洁机器人的控制方法、装置、清洁机器人及存储介质
CN112198876B (zh) * 2020-09-28 2023-10-03 湖南格兰博智能科技有限责任公司 一种适用于扫地机器人的带地图全覆盖清扫模块化控制方法
CN112947408B (zh) * 2021-01-19 2021-12-03 佛山市顺德区一拓电气有限公司 一种清洁设备的控制方法及装置
CN113693503A (zh) * 2021-06-11 2021-11-26 北京石头世纪科技股份有限公司 一种清扫方法、装置、扫地机及计算机可读介质
CN113966976B (zh) * 2021-09-28 2023-09-22 安克创新科技股份有限公司 清洁机器人及用于控制清洁机器人行进的方法
CN114587191B (zh) * 2022-01-26 2023-09-05 深圳市无限动力发展有限公司 扫地机分区清扫方法、装置、计算机设备和存储介质
CN115429172B (zh) * 2022-08-30 2023-09-29 云鲸智能(深圳)有限公司 清洁机器人的拖地方法、清洁机器人及存储介质

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE50301990D1 (de) * 2002-01-25 2006-01-26 Siemens Ag Verfahren und anordnung sowie computerprogramm mit programmcode-mitteln und computerprogramm-produkt zur planung von jeweils aus teilbahnen zusammengesetzten bahnen für eine mobile einheit in einer gesamtfläche
CN102113853A (zh) * 2011-02-28 2011-07-06 莱克电气股份有限公司 一种智能吸尘器清扫方法
JP2013168150A (ja) * 2012-02-16 2013-08-29 Micro-Star Internatl Co Ltd 充電ステーションおよび充電システム
CN103376801A (zh) * 2012-04-13 2013-10-30 科沃斯机器人科技(苏州)有限公司 自移动地面处理机器人及其清洁工作的控制方法
CN203609373U (zh) * 2013-11-20 2014-05-28 苏州科沃斯商用机器人有限公司 带有矫正装置的自移动机器人
CN103909514A (zh) * 2013-01-05 2014-07-09 科沃斯机器人科技(苏州)有限公司 自移动机器人长边作业移动控制总成及其控制方法
CN104644061A (zh) * 2013-11-20 2015-05-27 苏州科沃斯商用机器人有限公司 带有矫正装置的自移动机器人及其矫正方法
CN105425801A (zh) * 2015-12-10 2016-03-23 长安大学 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN105867370A (zh) * 2016-04-05 2016-08-17 山东理工大学 一种移动机器人全覆盖遍历混沌路径规划方法
CN106239528A (zh) * 2016-08-30 2016-12-21 宁波菜鸟智能科技有限公司 扫地机器人的路径清扫方法、装置及系统
CN106264359A (zh) * 2016-09-29 2017-01-04 苏州大学 清洁机器人及其避障方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101714000B (zh) * 2009-09-30 2012-07-04 刘瑜 一种自动吸尘器的路径规划方法
KR101686170B1 (ko) * 2010-02-05 2016-12-13 삼성전자주식회사 주행 경로 계획 장치 및 방법
KR101560446B1 (ko) * 2013-05-21 2015-10-26 이종훈 무전원 자동청소기
CN105511485B (zh) * 2014-09-25 2018-07-06 科沃斯机器人股份有限公司 用于自移动机器人栅格地图的创建方法
CN104757909B (zh) * 2015-01-22 2019-09-10 深圳市银星智能科技股份有限公司 一种清洁机器人的清洁模式
CN105223951B (zh) * 2015-09-14 2018-01-26 苏州爱普电器有限公司 自移动机器人
CN105739504B (zh) * 2016-04-13 2019-02-01 上海物景智能科技有限公司 一种机器人工作区域的排序方法及排序系统

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE50301990D1 (de) * 2002-01-25 2006-01-26 Siemens Ag Verfahren und anordnung sowie computerprogramm mit programmcode-mitteln und computerprogramm-produkt zur planung von jeweils aus teilbahnen zusammengesetzten bahnen für eine mobile einheit in einer gesamtfläche
CN102113853A (zh) * 2011-02-28 2011-07-06 莱克电气股份有限公司 一种智能吸尘器清扫方法
JP2013168150A (ja) * 2012-02-16 2013-08-29 Micro-Star Internatl Co Ltd 充電ステーションおよび充電システム
CN103376801A (zh) * 2012-04-13 2013-10-30 科沃斯机器人科技(苏州)有限公司 自移动地面处理机器人及其清洁工作的控制方法
CN103909514A (zh) * 2013-01-05 2014-07-09 科沃斯机器人科技(苏州)有限公司 自移动机器人长边作业移动控制总成及其控制方法
CN203609373U (zh) * 2013-11-20 2014-05-28 苏州科沃斯商用机器人有限公司 带有矫正装置的自移动机器人
CN104644061A (zh) * 2013-11-20 2015-05-27 苏州科沃斯商用机器人有限公司 带有矫正装置的自移动机器人及其矫正方法
CN105425801A (zh) * 2015-12-10 2016-03-23 长安大学 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN105867370A (zh) * 2016-04-05 2016-08-17 山东理工大学 一种移动机器人全覆盖遍历混沌路径规划方法
CN106239528A (zh) * 2016-08-30 2016-12-21 宁波菜鸟智能科技有限公司 扫地机器人的路径清扫方法、装置及系统
CN106264359A (zh) * 2016-09-29 2017-01-04 苏州大学 清洁机器人及其避障方法

Also Published As

Publication number Publication date
CN106970623A (zh) 2017-07-21

Similar Documents

Publication Publication Date Title
CN106970623B (zh) 智能清洁装置及其网格路径作业方法
CN105425801B (zh) 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN107544517B (zh) 智能清洁机器人的控制方法
CN110338715B (zh) 智能机器人清洁地面的方法和芯片以及清洁机器人
CN107340768B (zh) 一种智能机器人的路径规划方法
CN110974091B (zh) 清洁机器人及其控制方法、存储介质
WO2014135008A1 (zh) 一种沿边导航向中扩展的清洁机器人的清洁方法
JP7374547B2 (ja) 探測方法、装置、移動ロボット及び記憶媒体
US7085624B2 (en) Autonomous machine
CN106527423B (zh) 清洁机器人及其控制方法
US7053580B2 (en) Autonomous machine
CN112137529B (zh) 一种基于密集障碍物的清扫控制方法
WO2017088811A1 (zh) 自移动机器人及其行走模式转换方法和行走方法
CN101278820B (zh) 沿墙机器人吸尘器和控制该沿墙机器人吸尘器的方法
CN109068933A (zh) 借助机器人的机器人辅助表面处理
KR101372482B1 (ko) 이동 로봇의 경로 계획 방법 및 장치
CN103349531B (zh) 机器人吸尘器的侧边回归充电方法
CN108143364A (zh) 一种自移动清洁机器人清洁地图区域划分的方法
CN109997089A (zh) 地面处理机和地面处理方法
EP2870513B1 (en) Autonomous mobile robot and method for operating the same
CN108829115A (zh) 一种机器人的运动控制方法及其计算设备
CN102113853A (zh) 一种智能吸尘器清扫方法
AU2002337343A1 (en) An autonomous machine
CN107678429B (zh) 一种机器人的控制方法及芯片
CN111240308A (zh) 重复绕障的检测方法、装置、电子设备及可读存储介质

Legal Events

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