CN106647755A - 一种智能化实时构建清扫地图的扫地机器人 - Google Patents

一种智能化实时构建清扫地图的扫地机器人 Download PDF

Info

Publication number
CN106647755A
CN106647755A CN201611187495.9A CN201611187495A CN106647755A CN 106647755 A CN106647755 A CN 106647755A CN 201611187495 A CN201611187495 A CN 201611187495A CN 106647755 A CN106647755 A CN 106647755A
Authority
CN
China
Prior art keywords
sweeping robot
map
sweeping
gyroscope
master control
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
CN201611187495.9A
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.)
Shanghai Rui Intelligent Technology Co Ltd
Original Assignee
Shanghai Rui Intelligent 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 Shanghai Rui Intelligent Technology Co Ltd filed Critical Shanghai Rui Intelligent Technology Co Ltd
Priority to CN201611187495.9A priority Critical patent/CN106647755A/zh
Publication of CN106647755A publication Critical patent/CN106647755A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • 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

Landscapes

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

Abstract

本发明涉及一种智能化实时构建清扫地图的扫地机器人。它包括主控板、陀螺仪板、摄像头板、电机和码盘;主控板结合陀螺仪板采集的角度和加速度和摄像头板采集的位置信息,计算融合出当前位置坐标并进行存储;主控板根据定位程序流程不断获得及存储实时的位置坐标信息后,构建出扫地机器人所处空间的实时地图,并将实时地图存储在主控板的内存空间内;码盘为扫地机器人的速度控制检测元件,它反馈电机的行程位置状态并反馈给主控板。本发明不但可以有效降低扫地机器人主机板的MCU的压力,延长机器使用寿命,而且可以更加合理、高效率地规划清扫路线,获得更好的清扫覆盖率和清扫效果。

Description

一种智能化实时构建清扫地图的扫地机器人
技术领域
本发明涉及智能型家务机器人,特别是一种智能化实时构建清扫地图的扫地机器人。
背景技术
扫地机器人又叫懒人扫地机,是一种能对地面进行自动吸尘的智能家用电器。因为它能对房间大小、家俱摆放、地面清洁度等因素进行检测,并依靠内置的程序,制定合理的清洁路线,具备一定的智能,所以被人称之为机器人。扫地机器人作为智能家居新概念的领跑者,将为机器人最终走进千家万户,注入前进的动力。当然,目前的扫地机器人除了具有自动吸尘功能,还配备的水箱等机构以进行拖地操作。
如:现有中国发明专利公开说明书(公开号:CN105320140A)公开了一种扫地机器人及其清扫路径规划方法,该扫地机器人包括坐标系建立模块、地图构建模块和路径规划模块。其方法以扫地机器人最先找到的待清扫房间角落点为参考系,建立坐标系;再根据扫地机器人的清扫路径,构建出待清扫房间的地图,并记录构建过程中的碰撞点、房间的角落点、障碍物的顶点;最后根据记录的碰撞点、房间的角落点、障碍物的顶点,规划清扫路径。该扫地机器人及其清扫路径规划方法能够很好地适应未知环境,并且提高了清扫效率和面积,并且成本低,实用性强。
上述现有智能化实时构建清扫地图的扫地机器人在实际使用中,具有如下缺陷:
1、其智能化清扫路径规划主要依靠扫地机器人的大脑(即主机板的MCU)来实现,而该主机板的MCU还需要承担控制扫地机器人的电机运转、控制面板上的其它功能(功能示意、故障示意、运行方式示意),因此,其工作负担非常重,造成该扫地机器人的大脑使用过度。
2、其规划路径需要“最先找到的待清扫房间角落点为参考系,建立坐标系”,降低了路径规划的效率。
发明内容
本发明的目的在于提供一种智能化实时构建清扫地图的扫地机器人,主要解决上述现有技术所存在的技术缺陷,它不但可以有效降低扫地机器人主机板的MCU的压力,延长机器使用寿命,而且可以更加合理、高效率地规划清扫路线,获得更好的清扫覆盖率和清扫效果。
为实现上述目的,本发明的技术方案是:
一种智能化实时构建清扫地图的扫地机器人,其特征在于:它包括具有主控MCU的主控板、具有第一独立MCU和陀螺仪的陀螺仪板、具有第二独立MCU和摄像头的摄像头板、电机和码盘;其中:
该主控板结合陀螺仪板采集的扫地机器人的角度和加速度和摄像头板采集的扫地机器人的位置信息,计算融合出当前位置坐标并进行存储,然后进行陀螺仪矫正操作;主控板根据定位程序流程不断获得及存储实时的位置坐标信息后,构建出扫地机器人所处空间的实时地图,并将实时地图存储在主控板的内存空间内;
该陀螺仪板通过其陀螺仪获得角度和速度信息,并通过其第一独立MCU计算扫地机器人的角度和加速度;该陀螺仪板水平放置在扫地机器人机壳内并连接主控板;
该摄像头板的摄像头设置在扫地机器人机壳上方用于在第二独立MCU的控制下采集扫地机器人的位置信息;
该电机由主控板连接驱动扫地机器人的移动;
该码盘为扫地机器人的速度控制检测元件,它反馈电机的行程位置状态并反馈给主控板。
所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该陀螺仪板通过数据通过串口连接主控板。
所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该摄像头板与主控板通过串口双向通信连接。
所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该扫地机器人的定位流程包括如下步骤:
A、开机,以当前点为坐标原点;
B、陀螺仪和码盘、电机控制扫地机器人直行;
C、定时读取摄像头数据和陀螺仪数据;
D、主控板根据步骤C所采集的数据并根据上一次坐标数据,根据定位算法流程融合出当前位置坐标。
所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该步骤C中,摄像头板先通过摄像头获取一帧图像,在通过摄像头板的第二独立MCU提取特征值后与前一帧图像对比,计算出相对位置。
所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该步骤C中,陀螺仪能获取到角加速度和加速度信息,需要采用卡尔曼滤波算法过滤噪声。
的智能化实时构建清扫地图的扫地机器人,其特征在于:主控板构建出扫地机器人所处空间的实时地图包括如下步骤:
a、采用栅格法,将地图分割成一个个小栅格;
b、运动过程中,实时计算位置坐标;
c、遇到障碍物,该坐标的栅格置障碍物点;
d、多个障碍物点,汇合成一张完整的地图。
本发明的智能化实时构建清扫地图的扫地机器人具有如下总体优势:
A.采用了3个分模块MCU,减轻了主控MCU的压力。
B.提高了机器人清扫的覆盖率。
C.提高了机器人清扫的效率。
附图说明
图1是本发明的结构框图。
图2是本发明的定位方法流程图。
具体实施方式
有关本发明的详细说明和技术内容,配合图式说明如下,然而所附图式仅提供参考与说明用,非用以限制本发明。
请参阅图1,它是本发明一种智能化实时构建清扫地图的扫地机器人。如图所示:它包括具有主控MCU的主控板1、具有第一独立MCU和陀螺仪的陀螺仪板2、具有第二独立MCU和摄像头的摄像头板3、电机4和码盘5。
该主控板1结合陀螺仪板2采集的扫地机器人的角度和加速度和摄像头板3采集的扫地机器人的位置信息,计算融合出当前位置坐标并进行存储,然后进行陀螺仪矫正操作;主控板1根据定位程序流程不断获得及存储实时的位置坐标信息后,构建出机器人所处空间的实时地图,并将实时地图存储在主控板1的内存空间内。
该陀螺仪板2通过其陀螺仪获得角度和速度信息,并通过其第一独立MCU计算扫地机器人的角度和加速度;该陀螺仪板2水平放置在扫地机器人机壳内并连接主控板1。
该摄像头板3的摄像头设置在扫地机器人机壳上方用于在第二独立MCU的控制下采集扫地机器人的位置信息。
该电机4由主控板1连接驱动扫地机器人的移动。
该码盘5为扫地机器人的速度控制检测元件,它反馈电机4的行程位置状态并反馈给主控板1。
本发明中,该陀螺仪板2通过数据通过串口连接主控板1。
本发明中,该摄像头板3与主控板1通过串口双向通信连接。
如图2所示,该扫地机器人的定位流程包括如下步骤:
A、开机,以当前点为坐标原点;
B、陀螺仪和码盘、电机控制扫地机器人直行;
C、定时读取摄像头数据和陀螺仪数据;
D、主控板根据步骤C所采集的数据并根据上一次坐标数据,根据定位算法流程融合出当前位置坐标。
该步骤C中,摄像头板先通过摄像头获取一帧图像(比如:摄像头的图像传感器以120hz的速度获取752×480像素分辨率的图像),在通过摄像头板的第二独立MCU提取特征值后与前一帧图像对比,计算出相对位置。
比如:摄像头采集的图像,采用霍夫变换提取特征,霍夫变换(HoughTransform)是图像处理中的一种特征提取技术,它通过一种投票算法检测具有特定形状的物体。
在位置计算中,假定某t时刻A特征点图像附近区域的图像记作I(x,y,t),其中x,y是相对于A特征点的坐标。过了Δt之后,A特征点在视野中的位置发生了改变,x,y方向的位移为Δx,Δy,此时时刻为t+Δt,由于特征点的领域图像是保持恒定的,那么有:
I(x,y,t)=I(x+Δx,y+Δy,t+Δt)
只要在新图像中搜索与原图像亮度值一致的区域,通过对比像素之间的差距,就能求出Δx,Δy,从而求出机器移动的位置。
该步骤C中,陀螺仪能获取到角加速度和加速度信息,需要采用卡尔曼滤波算法过滤噪声。
角加速度积分得到角度θ,加速度积分得到速度d,码盘本身也能计算出速度,两个速度做滤波算法得出最终的速度,速度二次积分得到行程距离。
根据公式
x=d*sin(θ)
y=d*cos(θ)
即可计算出坐标(x,y)。
在上述步骤D中,主控板根据扫地机器人位置的变换,估算出机身的角度变化,矫正陀螺仪的角度。比如发现角度变大了,则减速陀螺仪角度,发现角度变小了,增大角度。
本发明扫地机器人构建地图,遵循如下原则:
1、采用栅格法,将地图分割成一个个小栅格。
2、运动过程中,实时计算位置坐标。
3、遇到障碍物,该坐标的栅格置障碍物点。
4、多个障碍物点,汇合成一张完整的地图。
以上所述者,仅为本发明的较佳可行实施例而已,非因此即局限本发明的专利范围,举凡运用本发明说明书及图式内容所为的等效结构变化,均理同包含于本发明的权利范围内,合予陈明。

Claims (7)

1.一种智能化实时构建清扫地图的扫地机器人,其特征在于:它包括具有主控MCU的主控板(1)、具有第一独立MCU和陀螺仪的陀螺仪板(2)、具有第二独立MCU和摄像头的摄像头板(3)、电机(4)和码盘(5);其中:
该主控板(1)结合陀螺仪板(2)采集的扫地机器人的角度和加速度和摄像头板(3)采集的扫地机器人的位置信息,计算融合出当前位置坐标并进行存储,然后进行陀螺仪矫正操作;主控板(1)根据定位程序流程不断获得及存储实时的位置坐标信息后,构建出扫地机器人所处空间的实时地图,并将实时地图存储在主控板(1)的内存空间内;
该陀螺仪板(2)通过其陀螺仪获得角度和速度信息,并通过其第一独立MCU计算扫地机器人的角度和加速度;该陀螺仪板(2)水平放置在扫地机器人机壳内并连接主控板(1);
该摄像头板(3)的摄像头设置在扫地机器人机壳上方用于在第二独立MCU的控制下采集扫地机器人的位置信息;
该电机(4)由主控板(1)连接驱动扫地机器人的移动;
该码盘(5)为扫地机器人的速度控制检测元件,它反馈电机(4)的行程位置状态并反馈给主控板(1)。
2.根据权利要求1所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该陀螺仪板(2)通过数据通过串口连接主控板(1)。
3.根据权利要求1所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该摄像头板(3)与主控板(1)通过串口双向通信连接。
4.根据权利要求1或2或3所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该扫地机器人的定位流程包括如下步骤:
A、开机,以当前点为坐标原点;
B、陀螺仪和码盘、电机控制扫地机器人直行;
C、定时读取摄像头数据和陀螺仪数据;
D、主控板根据步骤C所采集的数据并根据上一次坐标数据,根据定位算法流程融合出当前位置坐标。
5.根据权利要求4所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该步骤C中,摄像头板先通过摄像头获取一帧图像,在通过摄像头板的第二独立MCU提取特征值后与前一帧图像对比,计算出相对位置。
6.根据权利要求4所述的智能化实时构建清扫地图的扫地机器人,其特征在于:该步骤C中,陀螺仪能获取到角加速度和加速度信息,需要采用卡尔曼滤波算法过滤噪声。
7.根据权利要求1或2或3的智能化实时构建清扫地图的扫地机器人,其特征在于:主控板构建出扫地机器人所处空间的实时地图包括如下步骤:
a、采用栅格法,将地图分割成一个个小栅格;
b、运动过程中,实时计算位置坐标;
c、遇到障碍物,该坐标的栅格置障碍物点;
d、多个障碍物点,汇合成一张完整的地图。
CN201611187495.9A 2016-12-21 2016-12-21 一种智能化实时构建清扫地图的扫地机器人 Pending CN106647755A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611187495.9A CN106647755A (zh) 2016-12-21 2016-12-21 一种智能化实时构建清扫地图的扫地机器人

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611187495.9A CN106647755A (zh) 2016-12-21 2016-12-21 一种智能化实时构建清扫地图的扫地机器人

Publications (1)

Publication Number Publication Date
CN106647755A true CN106647755A (zh) 2017-05-10

Family

ID=58835196

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611187495.9A Pending CN106647755A (zh) 2016-12-21 2016-12-21 一种智能化实时构建清扫地图的扫地机器人

Country Status (1)

Country Link
CN (1) CN106647755A (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107368079A (zh) * 2017-08-31 2017-11-21 珠海市微半导体有限公司 机器人清扫路径的规划方法及芯片
CN107788914A (zh) * 2017-10-25 2018-03-13 深圳市亚谱达思科技有限公司 一种底置紫外线灯管的智能扫地机
CN107831772A (zh) * 2017-11-17 2018-03-23 北京奇虎科技有限公司 清洁路线的排布方法、装置及机器人
CN108062097A (zh) * 2017-12-11 2018-05-22 珠海格力电器股份有限公司 一种扫地机器人的构图修正方法和装置
CN108469264A (zh) * 2018-03-20 2018-08-31 杭州晶智能科技有限公司 一种基于角度分析的自动吸尘机器人最优路径规划方法
CN113932808A (zh) * 2021-11-02 2022-01-14 湖南格兰博智能科技有限责任公司 一种适用于视觉导航扫地机器人视觉和陀螺仪融合校正的算法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101549494A (zh) * 2009-05-11 2009-10-07 北京航空航天大学 具有自组装特征的单体自变形机器人
CN101612733A (zh) * 2008-06-25 2009-12-30 中国科学院自动化研究所 一种分布式多传感器移动机器人系统
CN101774170A (zh) * 2010-01-29 2010-07-14 华北电力大学 核电站作业机器人及其控制系统
CN103294060A (zh) * 2013-06-05 2013-09-11 苏州工业园区服务外包职业学院 一种中低速电缆巡检机器人控制系统
CN103499350A (zh) * 2013-09-28 2014-01-08 长安大学 Gps盲区下融合多源信息的车辆高精度定位方法及装置
CN104950904A (zh) * 2015-06-11 2015-09-30 陕西西科美芯科技集团有限公司 矿井应急救援飞行器自主飞行方法
CN105005249A (zh) * 2015-08-24 2015-10-28 铜陵学院 一种全自动四轮双核高速灭火机器人伺服控制器
CN105411490A (zh) * 2015-10-26 2016-03-23 曾彦平 移动机器人的实时定位方法及移动机器人
CN105513074A (zh) * 2015-06-17 2016-04-20 电子科技大学 一种羽毛球机器人相机标定方法
CN205281260U (zh) * 2016-01-06 2016-06-01 郑州大学 能够智能避障的新型搜救机器人

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101612733A (zh) * 2008-06-25 2009-12-30 中国科学院自动化研究所 一种分布式多传感器移动机器人系统
CN101549494A (zh) * 2009-05-11 2009-10-07 北京航空航天大学 具有自组装特征的单体自变形机器人
CN101774170A (zh) * 2010-01-29 2010-07-14 华北电力大学 核电站作业机器人及其控制系统
CN103294060A (zh) * 2013-06-05 2013-09-11 苏州工业园区服务外包职业学院 一种中低速电缆巡检机器人控制系统
CN103499350A (zh) * 2013-09-28 2014-01-08 长安大学 Gps盲区下融合多源信息的车辆高精度定位方法及装置
CN104950904A (zh) * 2015-06-11 2015-09-30 陕西西科美芯科技集团有限公司 矿井应急救援飞行器自主飞行方法
CN105513074A (zh) * 2015-06-17 2016-04-20 电子科技大学 一种羽毛球机器人相机标定方法
CN105005249A (zh) * 2015-08-24 2015-10-28 铜陵学院 一种全自动四轮双核高速灭火机器人伺服控制器
CN105411490A (zh) * 2015-10-26 2016-03-23 曾彦平 移动机器人的实时定位方法及移动机器人
CN205281260U (zh) * 2016-01-06 2016-06-01 郑州大学 能够智能避障的新型搜救机器人

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107368079A (zh) * 2017-08-31 2017-11-21 珠海市微半导体有限公司 机器人清扫路径的规划方法及芯片
CN107368079B (zh) * 2017-08-31 2019-09-06 珠海市一微半导体有限公司 机器人清扫路径的规划方法及芯片
CN107788914A (zh) * 2017-10-25 2018-03-13 深圳市亚谱达思科技有限公司 一种底置紫外线灯管的智能扫地机
CN107831772A (zh) * 2017-11-17 2018-03-23 北京奇虎科技有限公司 清洁路线的排布方法、装置及机器人
CN108062097A (zh) * 2017-12-11 2018-05-22 珠海格力电器股份有限公司 一种扫地机器人的构图修正方法和装置
CN108469264A (zh) * 2018-03-20 2018-08-31 杭州晶智能科技有限公司 一种基于角度分析的自动吸尘机器人最优路径规划方法
CN108469264B (zh) * 2018-03-20 2020-04-24 杭州晶一智能科技有限公司 一种基于角度分析的自动吸尘机器人最优路径规划方法
CN113932808A (zh) * 2021-11-02 2022-01-14 湖南格兰博智能科技有限责任公司 一种适用于视觉导航扫地机器人视觉和陀螺仪融合校正的算法
CN113932808B (zh) * 2021-11-02 2024-04-02 湖南格兰博智能科技有限责任公司 一种适用于视觉导航扫地机器人视觉和陀螺仪融合校正的算法

Similar Documents

Publication Publication Date Title
CN106647755A (zh) 一种智能化实时构建清扫地图的扫地机器人
US10612929B2 (en) Discovering and plotting the boundary of an enclosure
CN103431812B (zh) 一种基于超声雷达探测的清洁机器人及其行走控制方法
JP7106076B2 (ja) ロボットマッピングのためのシステムおよび方法
US11130238B2 (en) Mobile control method, mobile robot and computer storage medium
CN103064416B (zh) 巡检机器人室内外自主导航系统
CN111190419B (zh) 自移动机器人、组合机器人及组合机器人地图调用方法
CN105411490B (zh) 移动机器人的实时定位方法及移动机器人
CN105425801B (zh) 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN103353758B (zh) 一种室内机器人导航方法
CN104536445B (zh) 移动导航方法和系统
WO2020215901A1 (zh) 路径规划方法、电子设备、机器人及计算机可读存储介质
CN107065872A (zh) 智能机器人的栅格地图创建方法
CN109602356A (zh) 一种清洁机器人、智能补水方法及补水站
CN112650255A (zh) 一种基于视觉与激光雷达信息融合的机器人室内外定位导航系统方法
CN107340768A (zh) 一种智能机器人的路径规划方法
CN106227212A (zh) 基于栅格地图和动态校准的精度可控室内导航系统及方法
CN104858871A (zh) 机器人系统及其自建地图和导航的方法
CN107443385B (zh) 基于视觉的机器人直线导航的检测方法和芯片及机器人
US11561102B1 (en) Discovering and plotting the boundary of an enclosure
CN113741438A (zh) 路径规划方法、装置、存储介质、芯片及机器人
CN106826749B (zh) 移动机器人
CN105373130A (zh) 基于立体建模的特种设备事故现场信息探测系统
CN108784540A (zh) 一种扫地机器人自动避障行进装置及行进方法
CN107647828A (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
RJ01 Rejection of invention patent application after publication

Application publication date: 20170510

RJ01 Rejection of invention patent application after publication