CN105425801B - 基于先进路径规划技术的智能清洁机器人及其清洁方法 - Google Patents

基于先进路径规划技术的智能清洁机器人及其清洁方法 Download PDF

Info

Publication number
CN105425801B
CN105425801B CN201510918847.2A CN201510918847A CN105425801B CN 105425801 B CN105425801 B CN 105425801B CN 201510918847 A CN201510918847 A CN 201510918847A CN 105425801 B CN105425801 B CN 105425801B
Authority
CN
China
Prior art keywords
robot
obstacle
time
path
cleaned
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.)
Expired - Fee Related
Application number
CN201510918847.2A
Other languages
English (en)
Other versions
CN105425801A (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.)
Changan University
Original Assignee
Changan University
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 Changan University filed Critical Changan University
Priority to CN201510918847.2A priority Critical patent/CN105425801B/zh
Publication of CN105425801A publication Critical patent/CN105425801A/zh
Application granted granted Critical
Publication of CN105425801B publication Critical patent/CN105425801B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明涉及一种基于先进路径规划技术的智能清洁机器人及其清洁方法,包括安装在机器人机身上的外部环境信息探测系统、实时定位系统、主控制系统、电机驱动模块以及电源,外部环境信息探测系统用于探测外部环境信息;实时定位系统用于获取机器人自身所在的实时位置;主控制系统用于获取外部环境信息,并建立栅格地图,通过结合栅格地图和实时位置,规划出清扫路径;电机驱动模块用于驱动机器人按规划出的清扫路径运行并进行清扫;电源用于给主控制系统和电机驱动模块供电。本发明采用修扫边界、制造矩形、平行铺扫和兼顾障碍的路径规划技术设计出清洁路径,实时判断现处的位置,节省清洁时间,同时实现对其清扫环境的最大覆盖率。

Description

基于先进路径规划技术的智能清洁机器人及其清洁方法 【技术领域】
[0001] 本发明属于智能车领域,具体涉及一种基于先进路径规划技术的智能清洁机器人 及其清洁方法。 【背景技术】
[0002] 目前,公知的扫地机器的机身为无线机器,以圆盘型为主。使用充电电池为电源运 作,操作方式以遥控器、机器上的操作面板为主。一般能设定时间预约打扫,自行充电。机器 人前方设置有传感器,可侦测障碍物,如侦测到墙壁或其他障碍物,会自行转弯,依据不同 厂商设定,而按不同的判断机制行驶,有规划的清扫地区。(部分较早期机型可能缺少其中 部分功能)。一般的扫地机器人采用的是随机路径清扫方式,其清扫面积覆盖率低,容易发 生部分房间与角落的漏扫和重复清扫,且清洁耗时长。 【发明内容】
[0003] 本发明的目的在于克服现有技术中存在的问题,提供一种基于先进路径规划技术 的智能清洁机器人及其清洁方法,该机器人能够自动完成地板清理工作,能自动记录环境 地图判断自己的位置并规划出清洁路径进行清洁。
[0004] 为了达到上述目的,本发明清洁机器人采用如下技术方案:
[0005] 包括安装在机器人机身上的外部环境信息探测系统、实时定位系统、主控制系统、 电机驱动模块以及电源,其中:
[0006] 外部环境信息探测系统用于探测外部环境信息;实时定位系统用于获取机器人自 身所在的实时位置;主控制系统用于获取外部环境信息探测系统探测的外部环境信息,并 建立栅格地图,通过结合栅格地图和实时位置,用先进路径规划算法规划出清扫路径;电机 驱动模块用于驱动机器人按规划出的清扫路径运行并进行清扫;电源用于给主控制系统和 电机驱动模块供电。
[0007] 进一步地,外部环境信息探测系统包括均匀布置在机器人机身前侧的若干个红外 反射传感器,以及均匀布置在机身顶部的若干个超声波测距传感器,超声波测距传感器还 与充电基座相配合。
[0008] 进一步地,实时定位系统包括用于获取机器人角速度的陀螺仪、用于采集机器人 加速度的三轴加速度计以及用来采集机器人实时速度的增量型旋转编码器。
[0009] 进一步地,主控制系统还用于调整机器人的运行模式和行驶速度。
[0010] 进一步地,机器人的机身侧面安装有用来检测障碍的避障传感器,以及用于记录 突发碰撞情况的碰撞传感器。
[0011] 进一步地,机器人的机身底部安装有用于判断是否脱离地面的红外近距传感器。
[0012] 进一步地,电机驱动模块包括与主控制器相连的驱动电路,驱动电路同时连接用 于控制机器人运动的第一无刷直流电机和用于控制机器人清洁的第二无刷直流电机。
[0013] 本发明清洁方法采用如下技术方案,包括以下步骤:
[0014] 步骤一,对机器人进行初始化;
[0015] 步骤二,用户对机器人进行功能选择;
[0016] 步骤三:以充电基座为坐标原点,并在机器人工作平面上建立直角坐标系,通过机 器人机身上均匀分布的若干个超声波测距传感器接收来自充电基座的超声波信号,判断机 器人是否位于充电基座及电量是否充足,在机器人位于充电基座且电量充足时,进入步骤 四,否则返回充电基座并在电量不足时进行充电,然后进入步骤四;
[0017] 步骤四:探测机器人外部环境信息,建立栅格地图;
[0018] 步骤五:在栅格地图中将待清洁的区域分割成单元区域,先找出单元区域的边界 作为清扫路径的第一步,然后在整块的矩形区域中横坐标不变,沿着纵坐标从小到大方向 移动,到达顶端后,再沿着水平方向移动一个栅格,然后纵坐标从大到小方向移动,依次进 行,直至规划出清扫路径;
[0019] 步骤六:按规划出的清扫路径运行,进行清扫,并完成航迹推算定位;
[0020] 步骤七:在清扫过程中,进行路障扫描,遇到障碍时进行避障同时把障碍物所在位 置信息记录进地图数据中;
[0021] 步骤八:判断是否打扫完全部可清洁栅格,若清扫完成则进入步骤九;若没有结 束,返回步骤三;
[0022]步骤九:结束。
[0023] 进一步地,步骤六中航迹推算定位采用如下公式:
[0024] 601、在清扫过程中,每隔At的单位时间,通过陀螺仪获取一次机器人的加速度 ai,通过三轴加速度计采集一次机器人的角速度W1,其中参数角标i表示第i次测量,计算得
Figure CN105425801BD00061
到:
[0025]
[0026]
[0027]
[0028] 其中,Via表示机器人的实时速度,5^表示在第i个Δ t时间内的位移,0ia表示通过 式⑶计算得到的单位时间内机器人所转过的角度;并由以上式⑴〜⑶得到:
Figure CN105425801BD00062
[0029]
[0030]
[0031] 其中,Δ Xia表示X坐标的增量,Δ Yia表示Y坐标的增量;并由以上式⑷〜⑸得到 机器人当前坐标(Xa,Ya):
[0032]
Figure CN105425801BD00063
[0033] 602、机器人行驶的左轮和右轮分别连接第一无刷直流电机,第一无刷直流电机上 均安装有增量型旋转编码器;在清扫过程中,在每个At的单位时间内,分别获取左轮侧的 增量型旋转编码器发出的脉冲数nLi和右轮侧的增量型旋转编码器发出的脉冲数nRi,得到 单位时间内左轮所走过的路程dLi和单位时间内右轮所走过的路程dRi:
[0034]
Figure CN105425801BD00064
[0035] 其中,m为增量型旋转编码器转一圈所发出的脉冲数,R表示左轮和右轮的半径,从 而,单位时间内左轮和右轮的路程差
Figure CN105425801BD00065
[0036] 由]t 匕,
Figure CN105425801BD00071
[0037] 其中,0ib表示通过式(10)计算得到的单位时间内机器人所转过的角度,r为左轮和 右轮之间的距离;Sib为单位时间内左轮和右轮的路程平均值;
[0038] 同时
Figure CN105425801BD00072
[0039] 结合上式(10)〜(13),得到机器人当前坐标(Xb,Yb),
[0040]
Figure CN105425801BD00073
[0041] 603、通过步骤601和步骤602所得的坐标(Xa,Ya)和(Xb,Yb),获得机器人的精确坐 标为(X,Y) = (AXa+BXb,AYa+BYb),
[0042] 其中,A是陀螺仪的置信度值,B是增量型旋转编码器的置信度值,A和B是通过以下 方法分别获得的:
Figure CN105425801BD00074
[0043]
[0044]
[0045]
[0046] 其中Θ为机器人机身上的超声波测距传感器在能够收到来自充电基座的超声波信 号范围内,机器人和充电基座与X轴之间的实时夹角。
[0047] 进一步地,步骤七中的障碍物的边长为L,包括小型障碍、大型障碍和墙形障碍,其 避障方法如下:
[0048] (I)L彡25cm的为小型障碍,机器人遇到小型障碍时,在距离小型障碍5cm处,环绕 小型障碍清扫一圈,继续沿原清扫路线前进;
[0049] (2) 25<L< 100cm的为大型障碍,在距离大型障碍5cm处清扫一圈,然后在距离大 型障碍物15cm处清扫一圈;通过航迹推算定位实时获得机器人相对于充电基座的坐标,并 记录最后一圈清扫路径上水平坐标和纵坐标的最大值与最小值,求得水平坐标最大值和最 小值的平均值作为中心点的水平坐标,求得纵坐标的最大值和最小值的平均值,作为中心 点的纵坐标,以过中心点且分别平行于X轴的线段和平行于Y轴的线段,将未清扫区域划分 为四个单元域,进行S型清扫;
[0050] (3) L>100cm的为墙型障碍,在距离墙形障碍Icm处,沿边清扫,直到遇到转角处, 沿原路径返回起始点,继续之前清扫路线。
[0051] 与现有技术相比,本发明具有以下有益的技术效果:
[0052] 本发明机器人能够凭借着多传感器信息融合,记录环境地图,并基于先进路径规 划技术设计出最优的清洁路径,实时判断现处的位置并进行避障,可以在清洁地面时选择 最优路径来节省清洁时间,同时实现对其清扫环境的最大覆盖率。
[0053] 本发明清洁方法中采用修扫边界,制造矩形,平行铺扫,兼顾障碍的先进路径规划 算法,规划出最优清扫路径,实现对其清扫环境的最大覆盖率,有效避免房间与角落的漏扫 和重复清扫,极好地提尚清洁效率。
[0054] 进一步地,本发明通过采用陀螺仪、三轴加速度计和增量型旋转编码器配合来完 成航迹推算定位,同时利用机器人机身上的超声波测距传感器与充电基座的配合,精确的 测量出机器人和充电基座与X轴之间的夹角,并和陀螺仪与旋转编码器多次叠加所得到的 夹角比较,从而得到陀螺仪与增量型旋转编码器的偏差,减小陀螺仪或增量型旋转编码器 单独工作的偏差,从而实现机器人的精确定位,确定其本身在栅格地图中的位置。 【附图说明】
[0055] 图1为本发明的系统总框图。
[0056] 图2为本发明的硬件结构图。
[0057] 图3为本发明的流程图。
[0058] 图4为本发明的大型避障碍说明图。 【具体实施方式】
[0059] 下面结合附图对本发明做进一步详细说明。
[0060] 图1为系统的总框图,整个系统划分为4个主要部分:传感器部分,控制部分,人机 交互部分和电机驱动部分。控制部分中的主控制系统控制智能清洁机器人的两个用于运动 的第一无刷直流电机与两个用于清洁的第二无刷直流电机,并利用多传感器信息融合技术 不断调整智能清洁机器人的运行模式和行驶速度,实现智能清洁机器人的实时调整与控 制。再通过人机交互模块可以实现对智能清洁机器人工作状态和性能的显示,并通过wifi 技术可以完成智能清洁机器人的遥控与预约功能。
[0061] 图2为硬件结构图,主要包括:
[0062] (1)传感器部分:
[0063] 包括安装在机器人机身上的外部环境信息探测系统和实时定位系统。
[0064] 其中,外部环境信息探测系统用于探测外部环境信息,包括均匀布置在机器人机 身前侧的十一个红外反射传感器,以及均匀布置在机身顶部的四个超声波测距传感器;超 声波测距传感器还与充电基座相配合。在机器人机身上还安装有用于判断突发碰撞情况的 碰撞传感器,以及用来检测障碍情况的避障传感器。机器人的机身底部安装有用于判断是 否脱离地面的红外近距传感器。
[0065] 实时定位系统用于获取机器人自身所在的实时位置,包括陀螺仪模块和增量型旋 转编码器;陀螺仪模块中含有用于获取机器人角速度的陀螺仪,以及用于采集机器人加速 度的三轴加速度计;增量型旋转编码器用来采集机器人实时速度,其采集原理是:增量型旋 转编码器与第一无刷直流电机同轴,第一无刷直流电机旋转时,增量型旋转编码器的光栅 盘与第一无刷直流电机同步旋转,经发光二极管等电子元件组成的检测装置检测输出若干 脉冲信号,通过计算在一定时间内的输出脉冲的个数计算出当前第一无刷直流电机的转 速,从而采集到与第一无刷直流电机转速相等的各车轮转速,得出实时速度,增量型旋转编 码器与陀螺仪和三轴加速度计相配合,利于提高航迹精度。
[0066] (2)控制部分:控制电路以STM32为核心芯片,配备完善的外围电路。主要通过获取 传感器的反馈信号获取智能清洁机器人运行状态,并依此信息控制电机的运行和实现相关 功能。例如:获取避障传感器,碰撞传感器的反馈信号,将反馈信号经过控制部分的相关处 理与运算对路况进行判断,并传出相应的控制信号;获取机器人机身底部安装的红外近距 传感器的反馈信号,判断机身是否着地(如果机身底部和地面之间的距离超过阈值,则表明 机身离地,此时机器人自动关机);通过设置开关,判断车体内的集尘盒安装状态,在集尘盒 安装上后,会压住开关使开关闭合使电路导通,此时该电路将高电平信号传给处理器,使处 理器收到集尘盒已安装的信息,若处理器没有接收到高电平信号则故障灯亮;获取主面板 的信号从而控制智能清洁机器人的模式转换。
[0067] (3)人机交互部分:该部分主要由无线通信模块,按键,显示屏,蜂鸣器,LED组成。 其中无线通信实现手机与单片机进行信息传输;按键可以供用户选择模式,可以选择清扫 模式,比如自动清扫模式,快速清扫模式,选择速度等等,实现全区域的清洁,避免漏扫;当 智能清洁机器人处于不同模式或工作状态时,点亮不同的LED灯,提醒用户;将电池电量,当 前清扫完成度等信息显示在显示屏上。
[0068] (4)驱动电机部分:该部分由电机驱动电路、直流无刷电机、信号检测电路、系统保 护电路组成。
[0069] 本发明机器人的机体呈扁圆形,在机体前半段设置数个红外反射传感器,用来检 测障碍,进行障碍物的躲避,车底部设置红外近距传感器用于判断是否脱离地面,且呈三角 分布两个动力轮与一个万向轮,动力轮连接第一无刷直流电机,万向轮左右两侧分布动力 刷用于清理,动力刷连接第二无刷直流电机,底部中部设置进污口,机体上方分布按键与取 放垃圾装置。利用布置在机器反射人内部的小型真空吸尘器和布置在机器人前端的双扫刷 将地面杂物先吸纳进入自身的集尘盒,从而完成地面清理功能。利用充电基座发出的超声 波信号,和机器人顶部布置在四角的超声波接收器,确定充电基座的位置并能在电量不足 的时候自动回充电基座充电。在机身顶部的四个角落布置四组超声波测距传感器,互成九 十度夹角。
[0070] 本发明以圆盘机身为载体,利用含三轴加速度计的陀螺仪模块和增量型旋转编码 器实现室内定位、通过布置在机身前侧圆弧的红外反射传感器和机身上部的四个超声波测 距传感器感知外部环境、通过机身上部的超声波测距传感器与充电基座发射的超声波来确 定其相对充电机座的位置,并在电量不足时自动回充电基座充电、利用先进算法自动规划 最优清扫路径。本装置主要用于实现清洁时间最省,覆盖面积最大的室内清洁。
[0071] 参见图3,本发明主要的工作过程及原理如下:
[0072] 步骤一:开始,对机器人进行初始化;
[0073] 步骤二:用户对机器人进行功能选择,如速度和模式等;
[0074] 步骤三:充电基座位于墙壁拐角处或紧靠墙壁,以充电基座为坐标原点并在机器 人工作平面上建立直角坐标系,判断机器人是否位于充电基座,当机器人位于充电基座时, 若电量充足时直接进入步骤四,若电量不足则充电后进入步骤四;当机器人不在充电基座 时,开始沿边搜索充电基座,回到充电基座后,若电量不足则充电,电量充足则进入步骤四;
[0075] 步骤四:利用机身前侧成弧线布置的11个红外反射传感器,和布置在机器顶部的 四个角的超声波测距传感器,感知外部环境信息,包括机器人周围障碍物信息和充电基座 方位信息。
[0076] 401、在已知环境地图的情况下,机器人将使用超声波测距传感器和红外反射传感 器获得外部环境信息与已有的环境地图进行对比,当出现不一致之处时则更新环境地图信 息,当变动量超过阀值则重新绘制环境地图。
[0077] 402、在未知环境地图的情况下,机器人将利用红外反射传感器获取近处障碍物的 信息,并以20CM为边长的正方形作为栅格大小,建立栅格地图。栅格地图的单位域主要包含 了以下信息类型:
[0078] 栅格的位置坐标;
[0079] 栅格是否可通行;
[0080] 栅格在路径规划中的特征标识;
[0081] 栅格在单元区域分割的序号。
[0082] 步骤五:在已知环境地图和实时位置时,可以利用先进路径规划算法自动规划出 最优清扫路径。
[0083] 利用已有的栅格地图规划最优清扫路径,实现清洁时间最省。
[0084] 地图已知情况下的单元域域内规划遵循的基本原则是:修扫边界,制造矩形,平行 铺扫,兼顾障碍。
[0085] 即使用效率最高的覆盖方一一S型的规整扫地方式扫过地面,即机器人横坐标不 变,沿着纵坐标从小到大方向移动,到达顶端后,机器人沿着水平方向移动一个栅格,再纵 坐标从大到小方向移动,依次进行。这种方式对于矩形区域来说效率是最高,可是任务区域 往往并非理想的矩形,采用这种方法在曲折的边界过多转弯会影响速度,故在栅格地图中 将待清洁的区域先大致分块,分割成单元区域,如图4中的单元域1至单元域4,在具体路径 规划过程中优先沿着单元区域的边界清扫,然后在整块的矩形区域采用S型的规整扫地方 式。
[0086] 步骤六:按规划出的最优清扫路径运行,进行清扫;利用含三轴加速度计的陀螺仪 模块与增量型旋转编码器配合算法来完成航迹推算定位。该方法通过对陀螺仪模块提供的 加速度和角速度和增量型旋转编码器提供的双轮加速度进行二重积分,并依据航迹推算基 本算法,来对自身进行精确定位,确定其本身在栅格地图中的位置。
[0087] 601、基于陀螺仪的航迹推算公式如下:
Figure CN105425801BD00101
[0088]
[0089]
[0090] 其中a (t)表示t时刻的加速度,W⑴表示t时刻的角速度,S表示t时刻的位移,Θ表 示t时刻转过角度。且S(O) =ο,θ⑼=0。用数值分析的方法,将利用梯形数值积分公式,化 简运算公式为:
Figure CN105425801BD00102
[0091]
[0092]
[0093]
[0094] 表示第i次测量得到的加速度,Vla表示实时速度,Sla表示第i次At时间内的位 移,W1表示第i次测量得到的角速度,0la表示通过式(5)计算得到的单位时间内机器人所转 过的角度,At表示测量时间间隔,为单位时间;参数角标i,表示第i次测量得到的数据。其 中ai、Via和Sia都包含水平和竖直两个分量。
[0095] 由于上一次的积分得到的速度、位置结果中已经包含之前所有运动历史数据的信 息,所以在进行下一次航迹推算时,只需在上一次的速度、位置上进行递推即可。
Figure CN105425801BD00111
[0096]
[0097]
[0098]
[0099] 由上可得:
Figure CN105425801BD00112
[0100]
[0101]
[0102]
[0103] 其中,Δ Xia表示X坐标的增量,Δ Yia表示Y坐标的增量。(Xa,Ya)表示用陀螺仪和加 速度计得到的机器人当前坐标;参数角标i,表示第i次测量得到的数据。
[0104] 602、基于增量型旋转编码器的航迹推算公式如下:
Figure CN105425801BD00113
[0105]
[0106]
[0107]
[0108]
[0109] dLi为单位时间内左轮所走过的路程,nLi为左轮侧的增量型旋转编码器单位时间 内发出的脉冲数,m为增量型旋转编码器转一圈所发出的脉冲数,R表示车轮的半径;dRl为单 位时间内右轮所走过的路程,Mi为右轮侧的增量型旋转编码器单位时间内发出的脉冲数; A di为单位时间内左轮和右轮的路程差。
[0110] 0ib表示通过式(17)计算得到的单位时间内机器人所转过的角度,r为左轮和右轮 之间的距离;Sib为单位时间内左轮和右轮的路程平均值;Δ Xib表示X坐标的增量,Δ Yib表示 Y坐标的增量;(Xb,Yb)表示用增量型旋转编码器得到的机器人当前坐标;参数角标i,表示第 i次测量得到的数据。
[0111] 603、机器人的精确坐标为:
Figure CN105425801BD00114
[0112]
[0113]
[0114]
[0115]
[0116] A是陀螺仪的置信度值,B是增量型旋转编码器的置信度值;0la是单位时间内用陀 螺仪得到的机器人所转过的角度,9lb是单位时间内用增量型旋转编码器得到的机器人所转 过的角度,1为用陀螺仪得到的当前位置与原点沿X轴的夹角,以为用增量型旋转编码器得 至Ij的当前位置与原点沿X轴的夹角,j为Qa与喃差值。k为9b与θ的差值。θ为机身上的超声波 测距传感器在能够收到来自基座的超声波信号时,通过超声波经过四个超声波测距传感器 的不同时间,精确的测量出机器人和充电基座与X轴之间的实时夹角。利用这个精确的夹 角,来和陀螺仪与增量型旋转编码器多次叠加所得到的夹角比较,可以得到每个传感器的 偏差。当一个传感器出现错误的时候,其偏差会很大,其置信度就会变得很小,所以本发明 可以减少单个传感器的误差,也增加了传感器系统的容错率;在机身上的超声波测距传感 器无法收到来自基座的超声波信号时,A和B设为最近的一次取值。(X,Y)表示计算得到的机 器人精确坐标。
[0117] 步骤七:在清扫过程中,进行路障扫描,遇到障碍时进入避障程序同时把障碍物所 在位置信息记录进地图数据中。其中遇到障碍物时的避障碍策略分为三种,即墙形障碍策 略、小型障碍策略、大型障碍策略。参见图4,详细说明如下:
[0118] 当遇到障碍后首先依靠侧翼的红外反射传感器沿着障碍物边沿前进,若障碍物边 长小于25cm则定义为小型障碍,若障碍物边长大于25cm但小于IOOcm则定义为大型障碍,若 障碍物边长大于IOOcm则定义为墙型障碍。
[0119] 墙形障碍策略:首先依靠侧翼的红外反射传感器,在距离墙形障碍Icm处,沿边清 扫,直到遇到明显转角处,此时切出障碍清扫策略,沿原路径返回起始点,继续之前清扫路 线。
[0120] 小型障碍策略:遇到小型障碍时,在距离小型障碍5cm处,环绕小型障碍清扫一圈, 继续沿原清扫路线前进。
[0121] 大型障碍策略:遇到大型障碍时,在距离大型障碍5cm处清扫一圈,最后在距离大 型障碍物15cm处清扫一圈。在此过程中通过航迹推算法实时获得机器人相对于充电基座的 坐标,并记录最后一圈清扫路径上水平坐标和纵坐标的最大值与最小值。以所记录得到的 水平坐标的最大值和最小值的平均值,作为中心点的水平坐标。以所记录得到的纵坐标的 最大值和最小值的平均值,作为中心点的纵坐标。在得到障碍物的中心点后,过中心点生成 一条平行于X轴的线段和一条平行于Y轴的线段。这两条线段将除去大型障碍物的未清扫区 域划分为四个区块。再以这四个区块为清扫的单元域,逐个执行整齐的S型清扫。
[0122] 在清扫同时进行红外扫描并对红外近距传感器传回数据检测,检测车体是否离开 地面。若检测到车体离开地面,则停止所有功能进入待机状态。
[0123] 步骤八:判断是否打扫完全部可清洁栅格,若清扫完成则进入步骤九;若没有结 束,返回步骤三。
[0124] 步骤九:结束,沿规划路径返回充电基座的超声波信号范围内,直至回到充电基 座。
[0125] 本发明机器人能够凭借着多传感器信息融合技术,自动记录环境地图并实时判断 现处的位置,并基于先进路径规划技术,利用栅格地图与基于航迹的室内定位算法,将人机 交互和传感器的扫描检测部分放在主函数的循环里,而将用于判断是否能运行放在中断 里。设计出最优清洁路径。

Claims (9)

  1. I.基于先进路径规划技术的智能清洁机器人的清洁方法,其特征在于,包括以下步骤: 步骤一,对机器人进行初始化; 步骤二,用户对机器人进行功能选择; 步骤三:以充电基座为坐标原点并在机器人工作平面上建立直角坐标系,通过机器人 机身上均匀分布的若干个超声波测距传感器接收来自充电基座的超声波信号,判断机器人 是否位于充电基座及电量是否充足,在机器人位于充电基座且电量充足时,进入步骤四,否 则返回充电基座并在电量不足时进行充电,然后进入步骤四; 步骤四:探测机器人外部环境信息,建立栅格地图; 步骤五:在栅格地图中将待清洁的区域分割成单元区域,先找出单元区域的边界作为 清扫路径的第一步,然后在整块的矩形区域中横坐标不变,沿着纵坐标从小到大方向移动, 到达顶端后,再沿着水平方向移动一个栅格,然后纵坐标从大到小方向移动,依次进行,直 至规划出清扫路径; 步骤六:按规划出的清扫路径运行,进行清扫,并完成航迹推算定位; 步骤七:在清扫过程中,进行路障扫描,遇到障碍时进行避障同时把障碍物所在位置信 息记录进地图数据中; 步骤八:判断是否打扫完全部可清洁栅格,若清扫完成则进入步骤九;若没有清扫完 成,返回步骤三; 步骤九:结束; 步骤六中航迹推算定位采用如下公式: 601、 在清扫过程中,每隔Δ t的单位时间,通过陀螺仪获取一次机器人的加速度m,通过 三轴加速度计采集一次机器人的角速度W1,其中参数角标i表示第i次测量,计算得到: Via = O.5 (ai-1+ai) Δ t (1); Sia = 0.5(Vi-i+Vi) At (2); 0ia = 〇.5(ffi-l+ffi) At (3); 其中,Via表示机器人的实时速度,5^表示在第i个Δ t时间内的位移,0ia表示通过式(3) 计算得到的单位时间内机器人所转过的角度;并由以上式⑴〜⑶得到: A Xia = SiaCOS0ia (4) AYia = SiaSinQia (5) 其中,A Xia表示X坐标的增量,Δ Yia表示Y坐标的增量;并由以上式⑷〜⑸得到机器人 当前坐标(Xa,Ya): (Xa , Ya) = (Xia-I+ Δ Xia , Yia-I+ Δ Yia)⑹; 602、 机器人行驶的左轮和右轮分别连接第一无刷直流电机,第一无刷直流电机上均安 装有增量型旋转编码器;在清扫过程中,在每个At的单位时间内,分别获取左轮侧的增量 型旋转编码器发出的脉冲数1^和右轮侧的增量型旋转编码器发出的脉冲数nRl,得到单位 时间内左轮所走过的路程dLi和单位时间内右轮所走过的路程dRi:
    Figure CN105425801BC00021
    其中,m为增量型旋转编码器转一圈所发出的脉冲数,R表示左轮和右轮的半径,从而, 单位时间内左轮和右轮的路程差A di= I dLi-dRi I (9); 由此,
    Figure CN105425801BC00031
    :Sib = 0.5(dLi+dRi) (11); 其中,0lb表示通过式(10)计算得到的单位时间内机器人所转过的角度,r为左轮和右轮 之间的距离;Sib为单位时间内左轮和右轮的路程平均值; 同时 A Xib = SibcosQib (12) ; Δ Yib = SibsinQib (13); 结合上式(10)〜(13),得到机器人当前坐标(Xb,Yb), (Xb, Yb) = (Xib-i+ Δ Xib, Yib-i+ Δ Yib) (14); 603、通过步骤601和步骤602所得的坐标(Xa,Ya)和(Xb,Yb),获得机器人的精确坐标为 (X,Y) = (AXa+BXb,AYa+BYb), 其中,A是陀螺仪的置信度值,B是增量型旋转编码器的置信度值,A和B是通过以下方法 分别获得的:
    Figure CN105425801BC00032
    j = 0-0a (17) ; k=0-0b (18);
    Figure CN105425801BC00033
    其中Θ为机器人机身上的超声波测距传感器在能够收到来自充电基座的超声波信号 时,通过超声波经过四个超声波测距传感器的不同时间,精确的测量出机器人和充电基座 与X轴之间的实时夹角。
  2. 2. 根据权利要求1所述的基于先进路径规划技术的智能清洁机器人的清洁方法,其特 征在于,步骤七中的障碍物的边长为L,包括小型障碍、大型障碍和墙形障碍,其避障方法如 下: (1) L<25cm的为小型障碍,机器人遇到小型障碍时,在距离小型障碍5cm处,环绕小型 障碍清扫一圈,继续沿原清扫路线前进; (2) 25<L$100cm的为大型障碍,在距离大型障碍5cm处清扫一圈,然后在距离大型障 碍物15cm处清扫一圈;通过航迹推算定位实时获得机器人相对于充电基座的坐标,并记录 最后一圈清扫路径上水平坐标和纵坐标的最大值与最小值,求得水平坐标最大值和最小值 的平均值作为中心点的水平坐标,求得纵坐标的最大值和最小值的平均值,作为中心点的 纵坐标,以过中心点且分别平行于X轴的线段和平行于Y轴的线段,将未清扫区域划分为四 个单元域,进行S型清扫; (3) L>100cm的为墙型障碍,在距离墙形障碍Icm处,沿边清扫,直到遇到转角处,沿原 路径返回起始点,继续之前清扫路线。
  3. 3. 用于权利要求1所述清洁方法中的基于先进路径规划技术的智能清洁机器人,其特 征在于,包括安装在机器人机身上的外部环境信息探测系统、实时定位系统、主控制系统、 电机驱动模块以及电源,其中: 外部环境信息探测系统用于探测外部环境信息;实时定位系统用于获取机器人自身所 在的实时位置;主控制系统用于获取外部环境信息探测系统探测的外部环境信息,并建立 栅格地图,通过结合栅格地图和实时位置,用先进路径规划算法规划出清扫路径;电机驱动 模块用于驱动机器人按规划出的清扫路径运行并进行清扫;电源用于给主控制系统和电机 驱动模块供电。
  4. 4. 根据权利要求3所述的基于先进路径规划技术的智能清洁机器人,其特征在于,外部 环境信息探测系统包括均匀布置在机器人机身前侧的若干个红外反射传感器,以及均匀布 置在机身顶部的若干个超声波测距传感器,超声波测距传感器还与充电基座相配合。
  5. 5. 根据权利要求3所述的基于先进路径规划技术的智能清洁机器人,其特征在于,实时 定位系统包括用于获取机器人角速度的陀螺仪、用于采集机器人加速度的三轴加速度计以 及用来采集机器人实时速度的增量型旋转编码器。
  6. 6. 根据权利要求3所述的基于先进路径规划技术的智能清洁机器人,其特征在于,主控 制系统还用于调整机器人的运行模式和行驶速度。
  7. 7. 根据权利要求3所述的基于先进路径规划技术的智能清洁机器人,其特征在于,机器 人的机身侧面安装有用来检测障碍的避障传感器,以及用于记录突发碰撞情况的碰撞传感 器。
  8. 8. 根据权利要求3所述的基于先进路径规划技术的智能清洁机器人,其特征在于,机器 人的机身底部安装有用于判断是否脱离地面的红外近距传感器。
  9. 9. 根据权利要求3所述的基于先进路径规划技术的智能清洁机器人,其特征在于,电机 驱动模块包括与主控制系统相连的驱动电路,驱动电路同时连接用于控制机器人运动的第 一无刷直流电机和用于控制机器人清洁的第二无刷直流电机。
CN201510918847.2A 2015-12-10 2015-12-10 基于先进路径规划技术的智能清洁机器人及其清洁方法 Expired - Fee Related CN105425801B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510918847.2A CN105425801B (zh) 2015-12-10 2015-12-10 基于先进路径规划技术的智能清洁机器人及其清洁方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510918847.2A CN105425801B (zh) 2015-12-10 2015-12-10 基于先进路径规划技术的智能清洁机器人及其清洁方法

Publications (2)

Publication Number Publication Date
CN105425801A CN105425801A (zh) 2016-03-23
CN105425801B true CN105425801B (zh) 2018-06-12

Family

ID=55504070

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510918847.2A Expired - Fee Related CN105425801B (zh) 2015-12-10 2015-12-10 基于先进路径规划技术的智能清洁机器人及其清洁方法

Country Status (1)

Country Link
CN (1) CN105425801B (zh)

Families Citing this family (41)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105759820A (zh) * 2016-04-08 2016-07-13 济宁中科先进技术研究院有限公司 基于激光和视觉的道路自主清扫控制系统及控制方法
CN107305377A (zh) * 2016-04-19 2017-10-31 上海慧流云计算科技有限公司 一种室内地图自动绘制机器人及绘制方法
CN105867380B (zh) * 2016-04-19 2018-10-12 北京九星智元科技有限公司 一种机器人小车路径跟随方法
CN107305376A (zh) * 2016-04-19 2017-10-31 上海慧流云计算科技有限公司 一种室内地图自动绘制机器人及绘制方法
CN106125724A (zh) * 2016-06-13 2016-11-16 华讯方舟科技有限公司 一种机器人自主充电的方法及系统
CN106325275B (zh) * 2016-09-14 2019-08-20 广州今甲智能科技有限公司 一种机器人导航的系统、方法及装置
CN106325281A (zh) * 2016-10-30 2017-01-11 苏州市克拉思科文化传播有限公司 一种智能家居吸尘装置
CN106541403A (zh) * 2016-10-31 2017-03-29 河池学院 一种家用清洁机器人控制方法
CN108120441A (zh) * 2016-11-28 2018-06-05 沈阳新松机器人自动化股份有限公司 全覆盖路径规划方法及系统
CN106873587A (zh) * 2017-02-10 2017-06-20 苏州瑞得恩光能科技有限公司 用于太阳能面板清扫机器人的导航系统及其导航方法
CN106970623B (zh) * 2017-04-18 2021-05-25 杭州匠龙机器人科技有限公司 智能清洁装置及其网格路径作业方法
CN108803588A (zh) * 2017-04-28 2018-11-13 深圳乐动机器人有限公司 机器人的控制系统
CN109124543A (zh) * 2017-06-16 2019-01-04 奥坦机器人科技有限公司 机器人清洁装置及其相关方法
CN108422539B (zh) * 2017-08-12 2020-05-22 中民筑友科技投资有限公司 一种基于bim的构件抹光方法及装置
CN108422542B (zh) * 2017-08-12 2020-06-02 中民筑友科技投资有限公司 基于bim的构件生产方法、装置及构件生产系统
CN107456163A (zh) * 2017-09-06 2017-12-12 太仓埃特奥数据科技有限公司 一种无人超市卫生自动化清洁方法
CN107544498A (zh) * 2017-09-08 2018-01-05 珠海格力电器股份有限公司 可移动终端的移动路径规划方法及装置
CN107491077A (zh) * 2017-09-22 2017-12-19 衢州职业技术学院 一种基于手机app控制的室内清扫机器人
CN107450569A (zh) * 2017-09-27 2017-12-08 上海思岚科技有限公司 一种扫地机器人的控制方法及设备
CN107676881A (zh) * 2017-10-10 2018-02-09 适家(北京)科技有限公司 一种智能自主式空气净化装置
JP2019070984A (ja) * 2017-10-11 2019-05-09 日立アプライアンス株式会社 自律走行型掃除機及び自律走行型掃除機システム並びに移動体
CN107831772A (zh) * 2017-11-17 2018-03-23 北京奇虎科技有限公司 清洁路线的排布方法、装置及机器人
CN107976999B (zh) * 2017-11-21 2020-11-06 深圳市远弗科技有限公司 一种移动机器人及其避障和路径规划方法和系统
CN107807650A (zh) * 2017-11-29 2018-03-16 莱克电气股份有限公司 一种机器人的运动控制方法、装置及设备
CN107932525A (zh) * 2017-12-01 2018-04-20 王冬冬 智控式微型清洁机器人
CN108181903A (zh) * 2017-12-27 2018-06-19 长沙硕博电子科技股份有限公司 一种基于路面清洁度检测的环卫车作业路径规划方法
CN108335302A (zh) * 2018-01-26 2018-07-27 上海思岚科技有限公司 一种区域分割方法及装置
TWI673660B (zh) * 2018-05-29 2019-10-01 廣達電腦股份有限公司 用於機器人之自動充電系統以及方法
CN108896048A (zh) * 2018-06-01 2018-11-27 浙江亚特电器有限公司 用于移动载具的路径规划方法
CN108594828B (zh) * 2018-06-05 2021-05-07 北京智行者科技有限公司 一种清扫作业路径的生成方法
CN108733061B (zh) * 2018-06-05 2021-06-25 北京智行者科技有限公司 一种清扫作业的路径修正方法
CN109144067B (zh) * 2018-09-17 2021-04-27 长安大学 一种智能清洁机器人及其路径规划方法
CN109250809A (zh) * 2018-10-25 2019-01-22 罗德斌 一种用于污水池曝气处理的机器人
CN109240312B (zh) * 2018-11-23 2020-09-15 珠海市一微半导体有限公司 一种机器人的清扫控制方法和芯片以及清洁机器人
CN109341698B (zh) * 2018-11-29 2019-12-27 深圳市银星智能科技股份有限公司 一种移动机器人的路径选择方法及装置
CN109497891A (zh) * 2018-12-06 2019-03-22 河池学院 一种扫地机器人系统
CN109814546B (zh) * 2018-12-18 2020-11-06 珠海格力电器股份有限公司 一种扫地机器人控制方法、装置、存储介质及扫地机器人
CN109964596B (zh) * 2019-04-01 2020-07-31 华南农业大学 一种基于智能机器人的水稻直播装置与方法
CN111281272A (zh) * 2020-02-20 2020-06-16 湖南炬神电子有限公司 一种用坐标实现扫地机规划清扫的方法
CN111257834A (zh) * 2020-02-28 2020-06-09 广东美的厨房电器制造有限公司 声波接收装置、声波发射装置及声波定位系统
CN111342512A (zh) * 2020-02-28 2020-06-26 广东美的厨房电器制造有限公司 机器人的回充方法、装置及机器人系统

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102138769A (zh) * 2010-01-28 2011-08-03 深圳先进技术研究院 清洁机器人及其清扫方法
CN203882195U (zh) * 2014-06-13 2014-10-15 常州智宝机器人科技有限公司 基于多传感器融合的服务机器人及其充电座
CN104626204A (zh) * 2013-11-14 2015-05-20 沈阳新松机器人自动化股份有限公司 机器人自主充电对接系统和方法
CN204379163U (zh) * 2014-12-15 2015-06-10 杭州菲果科技有限公司 超薄扫地真空吸尘机器人

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW201305761A (zh) * 2011-07-21 2013-02-01 Ememe Robot Co Ltd 自走機器人及其定位方法
US9504367B2 (en) * 2013-11-20 2016-11-29 Samsung Electronics Co., Ltd. Cleaning robot and method for controlling the same

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102138769A (zh) * 2010-01-28 2011-08-03 深圳先进技术研究院 清洁机器人及其清扫方法
CN104626204A (zh) * 2013-11-14 2015-05-20 沈阳新松机器人自动化股份有限公司 机器人自主充电对接系统和方法
CN203882195U (zh) * 2014-06-13 2014-10-15 常州智宝机器人科技有限公司 基于多传感器融合的服务机器人及其充电座
CN204379163U (zh) * 2014-12-15 2015-06-10 杭州菲果科技有限公司 超薄扫地真空吸尘机器人

Also Published As

Publication number Publication date
CN105425801A (zh) 2016-03-23

Similar Documents

Publication Publication Date Title
CN105425801B (zh) 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN103645733B (zh) 自寻充电机器人及其自寻充电系统和方法
KR101566207B1 (ko) 로봇 청소기 및 그 제어방법
CN103054517B (zh) 机器人吸尘器以及用于该机器人吸尘器的控制方法
CN109144067B (zh) 一种智能清洁机器人及其路径规划方法
KR100963783B1 (ko) 로봇 청소기의 제어방법
AU2018100726A4 (en) Automatic cleaning device and cleaning method
CN106970623B (zh) 智能清洁装置及其网格路径作业方法
CN103054519A (zh) 机器人吸尘器以及用于控制该机器人吸尘器的方法
CN108143364B (zh) 一种自移动清洁机器人清洁地图区域划分的方法
WO2014135008A1 (zh) 一种沿边导航向中扩展的清洁机器人的清洁方法
CN207164586U (zh) 一种扫地机器人导航系统
CN107920709A (zh) 机器人清洁设备系统
EP2296072A2 (en) Asymmetric stereo vision system
CN102981148B (zh) 定位系统及其方法
CN108567379A (zh) 自走式清洁装置分区清洁方法及使用该方法的自走式清洁装置
CN102113853A (zh) 一种智能吸尘器清扫方法
CN107357297A (zh) 一种扫地机器人导航系统及其导航方法
CN110179404A (zh) 清洁机器人、清洁方法及计算机可读存储介质
CN110018686A (zh) 一种智能割草机的路径规划方法
CN109946715B (zh) 探测方法、装置、移动机器人及存储介质
CN110623606A (zh) 一种清洁机器人及其控制方法
CN202498547U (zh) 吸尘机器人的自主导航系统
CN209678392U (zh) 一种移动机器人
CN110403539A (zh) 清洁机器人的清洁控制方法、清洁机器人以及存储介质

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180612

Termination date: 20181210

CF01 Termination of patent right due to non-payment of annual fee