CN109144067A - 一种智能清洁机器人及其路径规划方法 - Google Patents

一种智能清洁机器人及其路径规划方法 Download PDF

Info

Publication number
CN109144067A
CN109144067A CN201811083718.6A CN201811083718A CN109144067A CN 109144067 A CN109144067 A CN 109144067A CN 201811083718 A CN201811083718 A CN 201811083718A CN 109144067 A CN109144067 A CN 109144067A
Authority
CN
China
Prior art keywords
cleaning robot
intelligent cleaning
map
sensor
path
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
CN201811083718.6A
Other languages
English (en)
Other versions
CN109144067B (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.)
CHINA HIGHWAY ENGINEERING CONSULTING GROUP Co Ltd
CHECC Data Co Ltd
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 CN201811083718.6A priority Critical patent/CN109144067B/zh
Publication of CN109144067A publication Critical patent/CN109144067A/zh
Application granted granted Critical
Publication of CN109144067B publication Critical patent/CN109144067B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals

Abstract

本发明公开了一种智能清洁机器人及其路径规划方法，传感器模块用于分析并反馈实时清洁环境信息；精准定位模块用于获取当前智能清洁机器人在环境地图上所在的位置；利用几何‑拓扑混合地图技术建立环境地图，通过结合环境地图和实时位置，用先进路径规划算法规划出最优清扫路径，并将数据上传云平台实现实时分析记录与控制；驱动模块用于按照规划出的最优路径驱动智能清洁机器人运行并进行清洁工作；人机交互模块能够利用温湿度传感器结合摄像头实现对智能清洁机器人工作状态和性能的显示，并通过wifi/蓝牙技术可以完成智能清洁机器人的遥控与预约功能。本发明降低劳动强度、提高劳动效率，适用于宾馆、酒店、图书馆、办公场所与大众家庭。

Description

一种智能清洁机器人及其路径规划方法
技术领域
本发明属于智能车技术领域，具体涉及一种基于先进路径规划技术的智能清洁机器人及其路径规划方法。
背景技术
目前，公知的扫地机器的机身为无线机器，以圆盘型为主。使用充电电池为电源运作，操作方式以遥控器、机器上的操作面板为主。一般能设定时间预约打扫，自行充电。机器人前方设置有传感器，可侦测障碍物，如侦测到墙壁或其他障碍物，会自行转弯，依据不同厂商设定，按照不同判断机制行驶并规划清扫地区。目前市场上大部分扫地机器人采用是并无精准定位的随机路径清扫方式，清扫面积覆盖率低，耗时长，效率低，容易发生部分房间与角落的漏扫和重复清扫，且清洁耗时长。而采用改进算法规划的扫地机器人优化了弓形清扫模式，但因为实现方式上没有定位，本质上还是随机式，价格较高，性价比较低。
发明内容
本发明所要解决的技术问题在于针对上述现有技术中的不足，提供一种智能清洁机器人及其路径规划方法，能够高效半自动或全自动的完成室内环境(地面)工作，能自动记录环境地图判断自己的位置并规划出最优清洁路径，将最新型的物联网芯片与智清洁能扫地机器人有机地融合起来，实现室内静音节能清扫，替代传统繁重的人工清洁工作。
本发明采用以下技术方案：
一种智能清洁机器人，包括控制单元、驱动模块、传感器模块、人机交互模块以及电源模块，驱动模块、传感器模块、人机交互模块、精准定位模块以及电源模块分别与控制单元连接；传感器模块用于分析并反馈实时清洁环境信息；精准定位模块用于获取当前智能清洁机器人在环境地图上所在的位置；控制单元采用ESP32双模中央控制单元，用于获取外部环境信息，利用几何-拓扑混合地图技术建立环境地图，通过结合环境地图和实时位置，用先进路径规划算法规划出最优清扫路径，并将数据上传云平台实现实时分析记录与控制；驱动模块用于按照规划出的最优路径驱动智能清洁机器人运行并进行清洁工作；人机交互模块能够利用温湿度传感器结合摄像头实现对智能清洁机器人工作状态和性能的显示，并通过wifi/蓝牙技术可以完成智能清洁机器人的遥控与预约功能，通过电源模块为智能清洁机器人供电。
具体的，传感器模块包括转角传感器、速度传感器、红外传感器、碰撞传感器以及超声波传感器，碰撞传感器用于记录突发碰撞情况；转角传感器用于对角度的实时测量或监控；速度传感器用于检测机器人运动速度；红外传感器与超声波传感器用来检测智能清洁机器人车体和路况，当随机障碍物出现在红外传感器与超声波传感器的检测范围内时，将检测信号发送给ESP32双模中央控制单元控制扫地机器人实现躲避。
进一步的，红外传感器3包括11组，间隔设置在智能清洁机器人前侧的圆弧形机身内，超声波传感器4包括4组，互成九十度夹角设置在机身前侧，在超声波传感中间设置有摄像头。
具体的，精准定位模块包括陀螺仪、光电编码器和摄像头，陀螺仪用于采集车身偏移的角速度、速度和加速度，判断智能清洁机器人的行走方向，配合室内导航定位系统与行走电机的运行状况；光电编码器用于采集智能清洁机器人的实际速度，摄像头设置在智能清洁机器人机身顶部，180°旋转用于监控和辅助定位。
具体的，人机交互模块包括通信模块，无线通信单元，按钮，摄像头，温湿度传感器，显示屏以及LED，无线通信单元用于实现手机与ESP32双模中央控制单元的信息传输；按钮用于供用户选择清扫模式及运动速度；温湿度传感器及摄像头与ESP32双模中央控制单元结合，在手机或者web端远程监测家中情况。
一种智能清洁机器人路径规划方法，利用所述的智能清洁机器人，具体步骤如下：
S1、打开按钮，连接家庭WiFi/手机蓝牙，对智能清洁机器人进行初始化设定；
S2、用户根据需求对清洁机器人进行功能选择；
S3、开始沿边搜索充电基站，回到基站后，若电量不足则充电，电量充足则进入步骤S4；
S4、利用机身前侧成弧线布置的红外近距传感器和布置在机器顶部超声波测距传感器，构建实时环境信息分析反馈，并利用几何-拓扑混合地图技术建立环境地图；
S5、利用陀螺仪模块与光电编码器配合获取机器人的加速度和角速度进行二重积分，依据几何-拓扑混合地图，对其自身进行定位；
S6、在已知环境地图和实时位置时，利用先进路径规划算法自动规划出最优清扫路径；
S7、智能清洁机器人按规划出的最优清扫路径运行进行清扫；
S8、在清扫过程中，进行路障扫描，遇到障碍时进入避障程序同时把障碍物所在位置信息记录进地图数据中；判断是否打扫完全部可清洁格栅，若清扫完成则结束；否则返回步骤S3。
具体的，步骤S4具体如下：
401、在已知环境地图的情况下，智能清洁机器人使用超声波传感器和红外传感器获得信息反馈，结合几何-拓扑混合定位与已有环境地图进行对比，当出现不一致之处时则更新环境地图信息，当变动量超过阀值则重新绘制环境地图；
402、当未知环境地图的情况下，智能清洁机器人利用近距红外传感器实现对环境感知，整体环境通过拓扑节点串联，保证局部精确定位，拓扑节点采用几何表述，同时维护环境地图表述的整体一致性，考虑方面包括提取常见环境特征、建立拐角垂直线段、根据经验阈值判断和定位拐点端点坐标；几何-拓扑混合地图定位推算在实际中拐角判断如下：
其中，(x1,y1,xc1,yc1)与(x2,y2,xc2,yc2)为形成拐角两条近似垂直线段；(xc1,yc1)和(xc2,yc2)为处于拐角区线段端点坐标，es和ed为阈值经验值；实际拐角断点坐标(xc,yc)可近似计算为：
具体的，步骤S5中，轨迹推算公式如下：
Vn＝Vn-1+0.5an-1+0.5an
Sn＝Sn-1+0.5Vn-1+0.5Vn
θn＝θn-1+0.5Wn-1+0.5Wn
其中，an表示加速度，Vn表示速度，Sn表示位移，Wn表示角速度，θn表示转过角度，参数角标n表示第n个测量点得到的数据，其中an，Vn，Sn具有水平和竖直分量。
具体的，步骤S6中，最优清扫路径包括地图已知情况下的单元域规划和地图未知情况下的路径规划；地图已知情况下的单元域规划的输入步骤如下：
输入代表地图二值二维数组map＝(x，y)；按照二维数组特点，坐标原点在左上角，y是高，x是宽，y向下递增，x向右递增；将x和y封装成一个类，进行传参，重写equals方法比较坐标(x,y)；map(k)＝map(k-1)，当x(k)＝x(k-1)，y(k)＝y(k-1)，否则map(k)＝map(k-2)，当x(k)不等于x(k-1)或y(k)不等于y(k-1)；封装路径结点类，字段包括：坐标、G值、F值、父结点，实现Comparable接口；最后数据结构为A*算法输入的所有数据封装在一起；
处理步骤如下：
算法中定义几个常量来确定：二维数组中BAR＝1值表示障碍物、PATH＝2为二维数组中绘制路径的代表值、DIRECT_VALUE＝10表示计算G值需要横纵移动代价，DIRECT_VALUE＝14表示斜移动代价；使用PriorityQueue与ArrayList定义Open和Close辅助表分别取最小值与保存结点；定义布尔类判断方法；计算H值，这里使用“曼哈顿”法，坐标分别取差值相加；从Open列表中查找结点；添加邻结点到Open表；回溯法绘制路径；开循环移动结点寻找路径，设定循环结束条件，Open表为空或者最终结点在Close表。
具体的，步骤S7中，在清扫过程中，进行路障扫描，遇到障碍时进入避障程序同时把障碍物所在位置信息记录进地图数据中，遇到障碍物时的避障碍策略为bug2障碍策略，具体为：
智能清洁机器人先跟踪障碍物的轮廓，当能直接移动到目标点时，立即离开；Bug算法中的m-line连接qstart和qgoal为一条固定不变的直线；遇到障碍物时智能清洁机器人会进入轮廓跟踪模式，当到达m-line上一个接近目标点的位置后，继续沿m-line驶向目标；如果智能清洁机器人再次在m-line遇到上之前的撞击点，则到达目标的路径不存在；在清扫同时进行红外扫描并对陀螺仪传回数据检测，检测智能清洁机器人车体是否离开地面；若检测到车体离开地面，则停止所有功能进入待机状态。
与现有技术相比，本发明至少具有以下有益效果：
本发明智能清洁机器人能够凭借多传感器信息融合技术，记录环境地图并实时判断现处的位置，并基于先进路径规划技术设计出最优清洁路径，可以在清洁地面时选择最优路径来节省清洁时间，同时实现对其清扫环境的最大覆盖率与清洁程度。
进一步的，能够凭借着多传感器信息融合技术，结合市场现有功能进行拓展，通过温湿度传感器或者摄像头获取室内环境状态，在出现异常时通过云平台，将异常情况发送至手机或者web端，远程监控家中的环境。
进一步的，精确定位智能扫地机器人在构建的环境地图上的位置，精确定位障碍物如桌椅等所在位置，实现能做到最大清洁度的最优路径规划，同时节约清洁时间。
进一步的，人机交互模块用于深度简化操作流程，优化人机交互中机器的易用性，通过扩展延伸其功能提高扫地机器人的智能反馈；使得用户更加方便地操控扫地机器人，随时随地能通过WiFi/蓝牙进行远程无线操控。扩展智能扫地机器人的功能，提升机器反馈，了解清洁状态以及机器的使用程度耗损程度，性能状态。同时利用摄像头，传感器使扫地机器人充当智能监控系统，让人在外出途中可以通过扫地机器人实时关注家庭情况，包括水电状况、安全情况、小孩老人的身体状况，实现一机多用，功能充分扩展延伸。
本发明还公开了一种智能清洁机器人路径规划方法，按照开始，初始化，定位，构建几何-拓扑混合环境地图，规划最优路径，开始清扫，能够更改切换不同清扫模式，自行设置机器人返航电量，大容量电池电量低于预定值后机器人自动返回充电桩进行充电。并记录环境地图记录断点清扫位置；电量充足后返回中断点位置继续清扫，最大可能减少重复清扫。
进一步的，利用机身前侧成弧线布置的红外近距传感器和布置在机器顶部超声波测距传感器，构建实时环境信息分析反馈，并利用几何-拓扑混合地图技术建立环境地图。
进一步的，通过陀螺仪和光电编码器准确计算出实时速度，转过角度和位移，再根据几何-拓扑混合地图，对其自身进行定位；陀螺仪和光电编码器是常用的测量角速度和机器人运动状态的工具，能对速度、加速度和角速度进行精准测量，即可解出机器人移动的距离以及转过的角度,再根据依据几何-拓扑混合地图，对其自身进行定位。这种方法具有自参自测的优点,即无需外部信息即可自行测量其运动参数。与市场上的航迹推算不同的是，通过陀螺仪和光电编码器测得的物理量更加精确，且不会随工作时间的推移,逐渐累进积分运算误差和定系统时差造成的误差。根据依据几何-拓扑混合地图，对其自身进行定位，适合长时间的精准定位。
进一步的，智能扫地机器人在熟悉房间规划后，能够选择最佳清扫模式，制定最佳的清洁路径，做到全面清洁、节省电量、代价最小。保证扫地机器人在有限的工作时间里达到最优的清洁效率且清扫时间最短。相比于传统扫地机器人，更快更全面完成清扫工作，大幅度减少电量消耗。
进一步的，bug2障碍策略在宾馆、酒店、图书馆、办公场所与大众家庭等复杂性不强的场合可进行完美避障。
综上所述，本发明降低劳动强度、提高劳动效率，适用于宾馆、酒店、图书馆、办公场所与大众家庭。利用多传感器融合技术，采用最优环境地图绘制、路径规划与避障算法，大容量电池断点续航模式，增添侧刷，滚刷前增加扫风装置，做到省时节电的高效率卫生清扫。人机交互中机器中易用性增强，利用摄像头与传感器，使扫地机器人充当智能监控系统。
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
附图说明
图1为本发明的系统总框图；
图2为本发明的硬件结构图；
图3为本发明的流程图；
图4为本发明的结构示意图；
图5为本发明的走廊几何-拓扑环境地图示意图；
图6为本发明的最优避障示意图；
图7为本发明的ESP32第三方平台接入原理示意图。
其中，1.万向轮；2.滚刷；3.红外传感器；4.超声波传感器；5.拖板位；6.垃圾收纳盒；7.挡风板；8.侧刷；9.旋转边刷。
具体实施方式
请参阅图1，本发明一种智能清洁机器人，包括控制单元、驱动模块、传感器模块、人机交互模块、精准定位模块以及电源模块，驱动模块、传感器模块、人机交互模块以及电源模块分别与控制单元连接；传感器模块用于分析并反馈实时清洁环境信息；精准定位模块用于获取当前智能清洁机器人在环境地图上所在的位置；控制单元采用ESP32双模中央控制单元，用于获取外部环境信息，利用几何-拓扑混合地图技术建立环境地图，通过结合环境地图和实时位置，用先进路径规划算法规划出最优清扫路径，并将数据上传云平台实现实时分析记录与控制；驱动模块用于按照规划出的最优路径驱动智能清洁机器人运行并进行清洁工作；人机交互模块能够利用温湿度传感器结合摄像头实现对智能清洁机器人工作状态和性能的显示，并通过wifi/蓝牙技术可以完成智能清洁机器人的遥控与预约功能，通过电源模块为智能清洁机器人供电。
请参阅图2，传感器模块包括，转角传感器，速度传感器，红外传感器以及超声波传感器。
其中，转角传感器用于对角度的实时测量或监控；速度传感器用来检测机器人运动速度；红外传感器与超声波传感器用来检测车体和路况，当随机障碍物出现在红外与超声波传感器的检测范围内时，传感器模块用于将检测信号发送给控制单元控制扫地机器人实现躲避。
精准定位模块包括陀螺仪、光电编码器和摄像头，陀螺仪用于采集车身偏移的角速度、速度和加速度，判断智能清洁机器人的行走方向，配合室内导航定位系统与行走电机的运行状况；光电编码器用于采集智能清洁机器人的实际速度，摄像头设置在智能清洁机器人机身顶部，180°旋转用于监控和辅助定位。
陀螺仪模块(含三轴加速度计)用来采集车身偏移的角速度、速度和加速度，判断出机器人的行走方向，配合室内导航定位系统与行走电机的运行状况，准确定位出XOY坐标碰撞传感器用于判断突发的碰撞情况；
控制单元以ESP32双模中央控制单元为核心芯片，配备外围电路进行完善。
传感器信号输入输出端与控制单元的传感器信号输入输出端相连，通过对传感器反馈信号的读取改变智能清洁器机人的运行状态，同时通过驱动模块控制电机的运行；利用多传感器反馈信息的融合实现对智能清扫机器人路况与运动状态及时判断；通过声光提示模块提示主面板的信号从而控制智能清洁机器人的模式转换。
人机交互模块包括通信模块(包括但不限于手机、电脑以及上位机通信)，无线通信单元，按钮，摄像头，温湿度传感器，显示屏以及LED。
其中，无线通信单元实现手机与主控芯片进行信息传输；按钮可以供用户选择清扫模式及运动速度等；
温湿度传感器及摄像头将与ESP32芯片相结合，通过ESP32第三方平台，在手机或者web端程序，远程监测家中情况。
请参阅图3，开始工作后，进行功能选择，智能清洁机器人返回充电基座，进行障碍和悬空扫描，进行位置计算和路径规划，进行电量检测，如果电量不充足，返回充电基座，电量充足，进行清洁完成度检测，如果清洁完成，返回充电基座，如果清洁未完成，返回进行障碍和悬空扫描。当智能清洁机器人处于不同模式或工作状态时，点亮不同的LED灯，提醒用户；将电源模块的电量，当前清扫完成度等信息显示在显示屏上。
用户可以通过HTTP协议在web服务器上进行独立应用授权，以确保隐私安全性。在web服务器上注册用户，管理此扫地机器人设备，创建与设备的关联，再通过web服务器与数据库中心进行信息的上传下载、交互，校准，更新。
在物联网层面，用户通过MQTT协议把扫地机器人的即时更新信息传给数据库中心，然后进行保存。用户通过登录UID进行Token的身份验证，也可以随时获取机器人的实时数据，控制设备自行检查、更新、操控机器人。
驱动模块包括电机驱动电路、直流无刷电机、信号检测电路、系统保护电路。
请参阅图4，本发明智能清洁机器人的机身呈扁圆状，采用前端两个旋转边刷9+真空吸尘+紫外灯杀菌+抗菌纤维抹布的清洁装置方案，在前侧的圆弧形机身内设置十一组红外传感器3与超声波传感器4用来检测障碍；利用布置在机器反射人内部的小型真空吸尘器和布置在机器人前端的旋转边刷9将地面杂物先吸纳进入自身的垃圾收纳盒6，从而完成地面清理功能。
超声波传感器4互成九十度夹角，利用充电基座发出的超声波信号和机器人顶部布置在四角的超声波传感器4，确定充电基座的位置并能在电量不足的时候自动回基座冲电。
摄像头位于机身顶部在四角分布的超声波传感中间，用于辅助精准定位与优化路径。
机身底部呈三角分布两个动力轮与一个万向轮1，旋转边刷9分别设置在万向轮1的两侧，位于万向轮1和两个动力轮之间，动力轮外侧分别设置有挡风板7，挡风板7的两侧机身上分别设置有侧刷8，机身底部中间设置进污口，进污口下侧设置拖板位5，进污口内设置滚刷2，进污口与机身内部的垃圾收纳盒6连通，机身上方分布按键与取放垃圾装置。
本发明以圆盘机身为载体，利用陀螺仪模块(含三轴加速度计)和光电编码器实现室内定位、通过布置在机身前侧圆弧的红外传感器和机身上部的四个超声波传感器感知外部环境、通过机身上部的超声波传感器与充电基座发射的超声波来确定其相对充电机座的位置，并在电量不足设定值时自动回冲电基座充电、利用先进算法自动规划最优清扫路径。本装置主要用于实现清洁时间最省，覆盖面积最大的室内清洁。
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。通常在此处附图中的描述和所示的本发明实施例的组件可以通过各种不同的配置来布置和设计。因此，以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围，而是仅仅表示本发明的选定实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图3，本发明一种智能清洁机器人的路径规划方法，按照开始，初始化，定位，构建几何-拓扑混合环境地图，规划最优路径，开始清扫，具体过程如下：
S1、开始，打开按钮，连接家庭WiFi/手机蓝牙，对清洁机器人进行初始化设定；
S2、用户根据需求对清洁机器人进行功能选择；
S3、开始沿边搜索充电基站(充电基站为坐标原点)，回到基站后，若电量不足则充电，电量充足则进入步骤S4；
S4、利用机身前侧成弧线布置的若干红外近距传感器，和布置在机器顶部超声波测距传感器，构建实时环境信息分析反馈(机器人周围障碍物信息和充电基座方位信息)，如图5所示，在对智能扫地机器人的环境地图进行抽样表述时，采用几何与拓扑两种描述方式。墙壁、房门、通路等静态物体与环境特征采用几何元素表示，各种对象的关系采用拓扑严格定量测量。拓扑节点与几何特征相互绑定，拓扑边给出相邻拓扑节点的可行路径与局部环境切换的可行通路。
401、在已知环境地图的情况下，机器人将使用超声波传感器和红外传感器获得信息反馈，结合几何-拓扑混合定位与已有环境地图进行对比，当出现不一致之处时则更新环境地图信息，当变动量超过阀值则重新绘制环境地图。
402、当未知环境地图的情况下，机器人将利用近距红外传感器实现对环境感知，整体环境通过拓扑节点串联，其中保证局部精确定位，拓扑节点采用几何表述。同时维护环境地图表述的整体一致性。其考虑方面如下：
提取常见环境特征
建立拐角垂直线段
根据经验阈值判断
定位拐点端点坐标
几何-拓扑混合地图定位推算公式如下：
设形成拐角两条近似垂直线段为(x1,y1,xc1,yc1)与(x2,y2,xc2,yc2)；处于拐角区线段端点坐标为(xc1,yc1)和(xc2,yc2)，阈值经验值记为es和ed；则在实际中拐角判断如下：
实际拐角断点坐标(xc,yc)可近似计算为：
S5、利用陀螺仪模块(含三轴加速度计)与光电编码器配合算法完成定位。该方法通过对陀螺仪模块(含三轴加速度计)提供的加速度和角速度进行二重积分，光电编码器亦同时记录航迹，并对陀螺仪所得到的运行轨迹进行修正，并依据轨迹推算基本算法，来对自身进行精确定位。
轨迹推算公式如下：
其中a(x)表示x时刻的加速度，w(x)表示x时刻的角加速度，S表示t时刻的位移，表示t时刻转过角度，这几个量均为矢量，S(0)＝0，θ(0)＝0。
用数值分析的方法，将利用梯形数值积分公式，化简运算公式为
其中，an表示加速度，Vn表示速度，Sn表示位移，Wn表示角速度，θn表示转过角度，Δt测量时间间隔，参数角标n表示第n个测量点得到的数据，其中an，Vn，Sn具有水平和竖直分量。
航迹推算的过程的每一次推算并不需要对之前所有的加度速度两次数值积分得到位置坐标，上一次的梯形积分得到的速度、位置结果中已经包含之前所有运动历史数据的信息，只需在上一次的速度、位置上进行递推即可。
Vn＝Vn-1+0.5an-1+0.5an
Sn＝Sn-1+0.5Vn-1+0.5Vn
θn＝θn-1+0.5Wn-1+0.5Wn
S6、在已知环境地图和实时位置时，可以利用先进路径规划算法自动规划出最优清扫路径；
利用已有的几何-拓扑混合地图规划最优清扫路径，实现清洁时间最省。其基本思想分为地图已知情况下的单元域规划和地图未知情况下的路径规划。
当未知环境地图的情况下，机器人利用近距红外传感器，构建实时环境信息分析反馈，并将整体环境通过拓扑节点串联，构建几何-拓扑环境地图后，进行地图已知情况下的单元域内路径规划。
地图已知情况下的单元域域内规划遵循的基本原则是：修扫边界，制造矩形，平行铺扫，兼顾障碍。采用离线事先规划的启发式搜索A*算法，在规划完毕之后，可以沿着最优路径移动。
在对节点按以下的方式进行排序：
F＝G+H
其中，F是计算出的权值，F值越大代表节点收益越小，G指从初始节点到达现在的节点的过程中付出的代价；H值指目前状态到目标状态预计代价；估算越准确，所需遍历节点越少。
对于h值的计算是采用启发式函数h(n)告诉A*从任意结点n到目标结点的最小代价评估值，从而控制A*的行为。
当启发式函数精确地等于实际最佳路径，此时A*扩展的结点将减少。A*算法则会实现：在每一结点它都计算f(n)＝g(n)+h(n)。当h(n)精确地和g(n)匹配时，f(n)的值在沿着该路径时将不会改变。不在最短路径上的所有结点的f值均大于正确路径上的f值。如果已经有较低f值的结点，A*将不考虑f值较高的结点，因此将不会偏离最短路径。
采用构造精确启发函数需要预先计算任意一对结点之间最短路径的长度。之后添加一个启发函数h’用于评估从任意位置到达邻近导航点(w)的代价。最终的启发式函数可以是：
h(n)＝h'(n,w1)+distance(w1,w2),h'(w2,goal)
我们参考了标准的启发式函数--曼哈顿距离。考虑代价函数并找到从一个位置移动到邻近位置的最小代价D。因此，启发式函数应该是曼哈顿距离的D倍：
H(n)＝D*(abs(n.x–goal.x)+abs(n.y–goal.y))
如果单位可以沿着任意角度移动(而不是网格方向)，那么可以使用直线距离：
h(n)＝D*sqrt((n.x-goal.x)^2+(n.y-goal.y)^2)
为了在搜索最优路径而带来的低效率问题(当某些路径具有相同的f值的时候，它们都将会被搜索，而我们只需要搜索其中的一条)将采用以下解决策略：我们将为启发函数添加一个附加值，附加值对于结点必须是确定性的，而且必须让f值体现差异。当A*对f值排序时，对于不同的f值将只有一个“需要的”的f值会被检测。
使用两个辅助表来记录结点，用于记录可被访问的结点，为Open表；记录已访问过结点为Close表；两个表决定了算法结束：条件是最终结点在Close表中(找到路径)或Open表为空(找不到了路径)；之后就来移动当前的节点，寻找路径；每次从Open表中取出F值最小的结点出来(使用优先队列来处理)，作为当前结点；然后将当前结点的所有邻结点按照邻结点规则加入到Open表中；最后将当前结点放入Close表中，这里就是每次循环的执行内容。
邻结点规则：
(1)当邻结点不在地图中，不加入Open表；
(2)当邻结点是障碍物，不加入Open表；
(3)当邻结点在Close表中，不加入Open表；
(4)当邻结点不在Open中，加入Open表，设该邻结点的父节点为当前结点；
(5)当邻结点在Open表中，需要做个比较：如果邻结点的G值>当前结点的G值+当前结点到这个邻结点的代价，那么修改该邻结点的父节点为当前的结点(在Open表中的结点除了起点，都会有父节点)，修改G值＝当前结点的G值+当前结点到这个邻结点的代价。
具体步骤如下：
1.输入
(1)输入代表地图二值二维数组map＝(x，y)；
(2)按照二维数组特点，坐标原点在左上角，y是高，x是宽，y向下递增，x向右递增；将x和y封装成一个类，进行传参，重写equals方法比较坐标(x,y)；map(k)＝map(k-1)，当x(k)＝x(k-1)，y(k)＝y(k-1)，否则map(k)＝map(k-2)，当x(k)不等于x(k-1)或y(k)不等于y(k-1)；
(3)封装路径结点类，字段包括：坐标、G值、F值、父结点，实现Comparable接口，方便优先队列排序。
(4)最后数据结构为A*算法输入的所有数据，封装在一起，方便传参。
2.处理
(1)算法中定义几个常量来确定：二维数组中BAR＝1值表示障碍物、PATH＝2为二维数组中绘制路径的代表值、DIRECT_VALUE＝10表示计算G值需要横纵移动代价，DIRECT_VALUE＝14表示斜移动代价；
(2)使用PriorityQueue与ArrayList定义Open和Close辅助表分别取最小值与保存结点。
Queue<Node>openList＝new PriorityQueue<Node>()；
List<Node>closeList＝new ArrayList<Node>()；
(3)定义布尔类判断方法：
最终结点的判断：return coord！＝null&&end.equals(coord)；
结点能否加入open表的判断：
如果(x<0||x>＝mapInfo.width||y<0||y>＝mapInfo.hight)，则终止，否则判断(mapInfo.maps[y][x]＝＝BAR)与(isCoordInClose(x,y)；
结点是否在Close表中的判断：node.coord.x＝＝x&&node.coord.y＝＝y；
(4)计算H值，这里使用“曼哈顿”法，坐标分别取差值相加
(5)从Open列表中查找结点
addNeighborNodeInOpen(mapInfo,current,x-1,y,DIRECT_VALUE)；//左
addNeighborNodeInOpen(mapInfo,current,x,y-1,DIRECT_VALUE)；//上
addNeighborNodeInOpen(mapInfo,current,x+1,y,DIRECT_VALUE)；//右
addNeighborNodeInOpen(mapInfo,current,x,y+1,DIRECT_VALUE)；//下
addNeighborNodeInOpen(mapInfo,current,x-1,y-1,OBLIQUE_VALUE)；//左上
addNeighborNodeInOpen(mapInfo,current,x+1,y-1,OBLIQUE_VALUE)；//右上
addNeighborNodeInOpen(mapInfo,current,x+1,y+1,OBLIQUE_VALUE)；//右下
addNeighborNodeInOpen(mapInfo,current,x-1,y+1,OBLIQUE_VALUE)；//左下
(6)添加邻结点到Open表；
(7)回溯法绘制路径；
(8)开循环移动结点寻找路径，设定循环结束条件，Open表为空或者最终结点在Close表。
S7、按规划出的最优清扫路径运行，进行清扫；
在清扫过程中，进行路障扫描，遇到障碍时进入避障程序同时把障碍物所在位置信息记录进地图数据中。其中遇到障碍物时的避障碍策略为bug2障碍策略；说明如下：
避障算法bug2避障算法
机器人先跟踪障碍物的轮廓，当它能直接移动到目标点时，就立即离开。如图6所示，Bug算法中的m-line连接qstart和qgoal，为一条固定不变的直线。遇到障碍物时机器人会进入轮廓跟踪模式，当其到达m-line上一个接近目标点的位置后(而非初次遇到障碍物的撞击点)，继续沿m-line驶向目标。如果机器人再次在m-line遇到上之前的撞击点，则到达目标的路径不存在。
在清扫同时进行红外扫描并对陀螺仪传回数据检测，检测车体是否离开地面。若检测到车体离开地面，则停止所有功能进入待机状态。
S8、判断是否打扫完全部可清洁格栅，若清扫完成则进入步骤S9；若没有结束，返回步骤S3；
S9、结束。
本发明机器人能够凭借着多传感器信息融合技术，自动记录环境地图并实时判断现处的位置，并基于先进路径规划技术，利用格栅地图与基于航迹的室内定位算法，将人机交互和传感器的扫描检测部分放在主函数的循环里，而将用于判断是否能运行放在中断里。设计出最优清洁路径。
以上内容仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明权利要求书的保护范围之内。

Claims (10)

1.一种智能清洁机器人，其特征在于，包括控制单元、驱动模块、传感器模块、人机交互模块以及电源模块，驱动模块、传感器模块、人机交互模块、精准定位模块以及电源模块分别与控制单元连接；传感器模块用于分析并反馈实时清洁环境信息；精准定位模块用于获取当前智能清洁机器人在环境地图上所在的位置；控制单元采用ESP32双模中央控制单元，用于获取外部环境信息，利用几何-拓扑混合地图技术建立环境地图，通过结合环境地图和实时位置，用先进路径规划算法规划出最优清扫路径，并将数据上传云平台实现实时分析记录与控制；驱动模块用于按照规划出的最优路径驱动智能清洁机器人运行并进行清洁工作；人机交互模块能够利用温湿度传感器结合摄像头实现对智能清洁机器人工作状态和性能的显示，并通过wifi/蓝牙技术可以完成智能清洁机器人的遥控与预约功能，通过电源模块为智能清洁机器人供电。
2.根据权利要求1所述的一种智能清洁机器人，其特征在于，传感器模块包括转角传感器、速度传感器、红外传感器、碰撞传感器以及超声波传感器，碰撞传感器用于记录突发碰撞情况；转角传感器用于对角度的实时测量或监控；速度传感器用于检测机器人运动速度；红外传感器与超声波传感器用来检测智能清洁机器人车体和路况，当随机障碍物出现在红外传感器与超声波传感器的检测范围内时，将检测信号发送给ESP32双模中央控制单元控制扫地机器人实现躲避。
3.根据权利要求2所述的一种智能清洁机器人，其特征在于，红外传感器3包括11组，间隔设置在智能清洁机器人前侧的圆弧形机身内，超声波传感器4包括4组，互成九十度夹角设置在机身前侧，在超声波传感中间设置有摄像头。
4.根据权利要求1所述的一种智能清洁机器人，其特征在于，精准定位模块包括陀螺仪、光电编码器和摄像头，陀螺仪用于采集车身偏移的角速度、速度和加速度，判断智能清洁机器人的行走方向，配合室内导航定位系统与行走电机的运行状况；光电编码器用于采集智能清洁机器人的实际速度，摄像头设置在智能清洁机器人机身顶部，180°旋转用于监控和辅助定位。
5.根据权利要求1所述的一种智能清洁机器人，其特征在于，人机交互模块包括通信模块，无线通信单元，按钮，摄像头，温湿度传感器，显示屏以及LED，无线通信单元用于实现手机与ESP32双模中央控制单元的信息传输；按钮用于供用户选择清扫模式及运动速度；温湿度传感器及摄像头与ESP32双模中央控制单元结合，在手机或者web端远程监测家中情况。
6.一种智能清洁机器人路径规划方法，其特征在于，利用权利要求1至5中任一项所述的智能清洁机器人，具体步骤如下：
S1、打开按钮，连接家庭WiFi/手机蓝牙，对智能清洁机器人进行初始化设定；
S2、用户根据需求对清洁机器人进行功能选择；
S3、开始沿边搜索充电基站，回到基站后，若电量不足则充电，电量充足则进入步骤S4；
S4、利用机身前侧成弧线布置的红外近距传感器和布置在机器顶部超声波测距传感器，构建实时环境信息分析反馈，并利用几何-拓扑混合地图技术建立环境地图；
S5、利用陀螺仪模块与光电编码器配合获取机器人的加速度和角速度进行二重积分，依据几何-拓扑混合地图，对其自身进行定位；
S6、在已知环境地图和实时位置时，利用先进路径规划算法自动规划出最优清扫路径；
S7、智能清洁机器人按规划出的最优清扫路径运行进行清扫；
S8、在清扫过程中，进行路障扫描，遇到障碍时进入避障程序同时把障碍物所在位置信息记录进地图数据中；判断是否打扫完全部可清洁格栅，若清扫完成则结束；否则返回步骤S3。
7.根据权利要求6所述的一种智能清洁机器人路径规划方法，其特征在于，步骤S4具体如下：
401、在已知环境地图的情况下，智能清洁机器人使用超声波传感器和红外传感器获得信息反馈，结合几何-拓扑混合定位与已有环境地图进行对比，当出现不一致之处时则更新环境地图信息，当变动量超过阀值则重新绘制环境地图；
402、当未知环境地图的情况下，智能清洁机器人利用近距红外传感器实现对环境感知，整体环境通过拓扑节点串联，保证局部精确定位，拓扑节点采用几何表述，同时维护环境地图表述的整体一致性，考虑方面包括提取常见环境特征、建立拐角垂直线段、根据经验阈值判断和定位拐点端点坐标；几何-拓扑混合地图定位推算在实际中拐角判断如下：
其中，(x1,y1,xc1,yc1)与(x2,y2,xc2,yc2)为形成拐角两条近似垂直线段；(xc1,yc1)和(xc2,yc2)为处于拐角区线段端点坐标，es和ed为阈值经验值；实际拐角断点坐标(xc,yc)可近似计算为：
8.根据权利要求6所述的一种智能清洁机器人路径规划方法，其特征在于，步骤S5中，轨迹推算公式如下：
Vn＝Vn-1+0.5an-1+0.5an
Sn＝Sn-1+0.5Vn-1+0.5Vn
θn＝θn-1+0.5Wn-1+0.5Wn
其中，an表示加速度，Vn表示速度，Sn表示位移，Wn表示角速度，θn表示转过角度，参数角标n表示第n个测量点得到的数据，其中an，Vn，Sn具有水平和竖直分量。
9.根据权利要求6所述的一种智能清洁机器人路径规划方法，其特征在于，步骤S6中，最优清扫路径包括地图已知情况下的单元域规划和地图未知情况下的路径规划；地图已知情况下的单元域规划的输入步骤如下：
输入代表地图二值二维数组map＝(x，y)；按照二维数组特点，坐标原点在左上角，y是高，x是宽，y向下递增，x向右递增；将x和y封装成一个类，进行传参，重写equals方法比较坐标(x,y)；map(k)＝map(k-1)，当x(k)＝x(k-1)，y(k)＝y(k-1)，否则map(k)＝map(k-2)，当x(k)不等于x(k-1)或y(k)不等于y(k-1)；封装路径结点类，字段包括：坐标、G值、F值、父结点，实现Comparable接口；最后数据结构为A*算法输入的所有数据封装在一起；
处理步骤如下：
算法中定义几个常量来确定：二维数组中BAR＝1值表示障碍物、PATH＝2为二维数组中绘制路径的代表值、DIRECT_VALUE＝10表示计算G值需要横纵移动代价，DIRECT_VALUE＝14表示斜移动代价；使用PriorityQueue与ArrayList定义Open和Close辅助表分别取最小值与保存结点；定义布尔类判断方法；计算H值，这里使用“曼哈顿”法，坐标分别取差值相加；从Open列表中查找结点；添加邻结点到Open表；回溯法绘制路径；开循环移动结点寻找路径，设定循环结束条件，Open表为空或者最终结点在Close表。
10.根据权利要求6所述的一种智能清洁机器人路径规划方法，其特征在于，步骤S7中，在清扫过程中，进行路障扫描，遇到障碍时进入避障程序同时把障碍物所在位置信息记录进地图数据中，遇到障碍物时的避障碍策略为bug2障碍策略，具体为：
智能清洁机器人先跟踪障碍物的轮廓，当能直接移动到目标点时，立即离开；Bug算法中的m-line连接qstart和qgoal为一条固定不变的直线；遇到障碍物时智能清洁机器人会进入轮廓跟踪模式，当到达m-line上一个接近目标点的位置后，继续沿m-line驶向目标；如果智能清洁机器人再次在m-line遇到上之前的撞击点，则到达目标的路径不存在；在清扫同时进行红外扫描并对陀螺仪传回数据检测，检测智能清洁机器人车体是否离开地面；若检测到车体离开地面，则停止所有功能进入待机状态。
CN201811083718.6A 2018-09-17 2018-09-17 一种智能清洁机器人及其路径规划方法 Active CN109144067B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811083718.6A CN109144067B (zh) 2018-09-17 2018-09-17 一种智能清洁机器人及其路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811083718.6A CN109144067B (zh) 2018-09-17 2018-09-17 一种智能清洁机器人及其路径规划方法

Publications (2)

Publication Number Publication Date
CN109144067A true CN109144067A (zh) 2019-01-04
CN109144067B CN109144067B (zh) 2021-04-27

Family

ID=64814531

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811083718.6A Active CN109144067B (zh) 2018-09-17 2018-09-17 一种智能清洁机器人及其路径规划方法

Country Status (1)

Country Link
CN (1) CN109144067B (zh)

Cited By (33)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109828587A (zh) * 2019-03-08 2019-05-31 南京康尼智控技术有限公司 一种避障系统及避障方法
CN109871013A (zh) * 2019-01-31 2019-06-11 莱克电气股份有限公司 清洁机器人路径规划方法及系统、存储介质、电子设备
CN109901577A (zh) * 2019-04-04 2019-06-18 杭州向上机器人科技有限公司 一种用于机器人的控制系统
CN110081312A (zh) * 2019-05-07 2019-08-02 核芯互联(北京)科技有限公司 一种油田管道伴热控制系统
CN110138030A (zh) * 2019-05-13 2019-08-16 深圳创动科技有限公司 机器人及其充电控制方法以及存储介质
CN110142782A (zh) * 2019-06-14 2019-08-20 武汉创现科技有限公司 一种用于床面杀菌的机器人及其智能遍历床面的方法
CN110281233A (zh) * 2019-05-13 2019-09-27 深圳创动科技有限公司 机器人、机器人控制系统和运动控制方法以及存储介质
CN110398964A (zh) * 2019-07-16 2019-11-01 浙江大学 一种低能量损耗机器人全覆盖路径规划方法及系统
CN110443175A (zh) * 2019-07-29 2019-11-12 苏州维众数据技术有限公司 基于分离式视觉检测的清洁机器人控制系统及控制方法
CN110456789A (zh) * 2019-07-23 2019-11-15 中国矿业大学 一种清洁机器人的全覆盖路径规划方法
CN111203899A (zh) * 2020-03-13 2020-05-29 佛山科学技术学院 一种教育机器人及其控制系统
CN111281272A (zh) * 2020-02-20 2020-06-16 湖南炬神电子有限公司 一种用坐标实现扫地机规划清扫的方法
CN111580514A (zh) * 2020-05-07 2020-08-25 中国船舶重工集团公司第七一六研究所 基于联合编队的移动机器人最优路径覆盖方法
CN111708368A (zh) * 2020-07-07 2020-09-25 上海工程技术大学 一种基于激光与视觉slam融合的智能轮椅
CN111813124A (zh) * 2020-07-22 2020-10-23 浙江迈睿机器人有限公司 一种基于拓扑地图的移动机器人混合调度方法
CN112198883A (zh) * 2020-12-09 2021-01-08 苏州光格设备有限公司 一种用于巡检机器人系统的轨道分段标定方法
WO2021068150A1 (en) * 2019-10-10 2021-04-15 Huawei Technologies Co., Ltd. Controlling method of mobile apparatus and computer program thereof
CN112880113A (zh) * 2021-01-22 2021-06-01 昆明理工大学 一种室内污染净化智能移动多功能装置及净化方法
CN113017492A (zh) * 2021-02-23 2021-06-25 江苏柯林博特智能科技有限公司 一种基于清洁机器人的物体识别智能控制系统
CN113180557A (zh) * 2021-04-25 2021-07-30 珠海格力电器股份有限公司 设备重定位作业恢复方法、装置、计算机设备和存储介质
CN113884574A (zh) * 2021-11-03 2022-01-04 河南理工大学 基于slam的智能测路面纵断面平整度仪
CN113907647A (zh) * 2021-10-13 2022-01-11 广东小伊室集智能科技有限公司 扫地机发光控制系统
CN113985881A (zh) * 2021-10-29 2022-01-28 温州大学 一种基于双向爬虫的移动机器人路径规划方法
CN114281071A (zh) * 2021-04-13 2022-04-05 南京天之博特机器人科技有限公司 一种ros ai-iot智能自主导航机器人的控制系统
CN114322279A (zh) * 2022-01-07 2022-04-12 深圳市丰用实业集团有限公司 一种家居空气智能净化系统及方法
WO2022104796A1 (zh) * 2020-11-23 2022-05-27 深圳元戎启行科技有限公司 用于智能行动的多域控制器、控制系统和控制方法
CN114800507A (zh) * 2022-04-27 2022-07-29 北京龙诚智航科技有限公司 一种主从式机械臂控制系统
CN114947664A (zh) * 2022-06-22 2022-08-30 汇智机器人科技(深圳)有限公司 一种应用于扫地机器人激光指引的控制方法、系统
CN115041483A (zh) * 2022-06-13 2022-09-13 合肥仁洁智能科技有限公司 一种清扫机器人及其控制方法
CN116027794A (zh) * 2023-03-30 2023-04-28 深圳市思傲拓科技有限公司 一种基于大数据的泳池机器人自动定位管理系统及方法
CN116107321A (zh) * 2023-04-13 2023-05-12 无锡科技职业学院 基于视觉与激光雷达融合的无人车路径规划系统及方法
WO2023115660A1 (zh) * 2021-12-22 2023-06-29 广东栗子科技有限公司 自动清洁地面的方法及装置
CN117031986A (zh) * 2023-10-10 2023-11-10 江苏通创现代建筑产业技术研究院有限公司 一种建筑幕墙自动化清洁的控制方法及系统

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0546633A2 (en) * 1991-12-11 1993-06-16 Koninklijke Philips Electronics N.V. Path planning in an uncertain environment
US20050216182A1 (en) * 2004-03-24 2005-09-29 Hussain Talib S Vehicle routing and path planning
US20060020369A1 (en) * 2004-03-11 2006-01-26 Taylor Charles E Robot vacuum cleaner
JP2008157698A (ja) * 2006-12-22 2008-07-10 Internatl Business Mach Corp <Ibm> 経路探索方法、プログラム及びシステム
CN103529843A (zh) * 2013-10-17 2014-01-22 电子科技大学中山学院 Lambda*路径规划算法
US20140100693A1 (en) * 2012-10-05 2014-04-10 Irobot Corporation Robot management systems for determining docking station pose including mobile robots and methods using same
CN103971008A (zh) * 2014-05-19 2014-08-06 浪潮电子信息产业股份有限公司 改进的启发式a*算法
US9069354B2 (en) * 2012-07-19 2015-06-30 Center Of Human-Centered Interaction For Coexistence Method for planning path for autonomous walking humanoid robot
CN105425801A (zh) * 2015-12-10 2016-03-23 长安大学 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN205306899U (zh) * 2015-12-30 2016-06-15 广东石油化工学院 一种室内slam险情检测与监控一体化智能清洁机器人
CN105955280A (zh) * 2016-07-19 2016-09-21 Tcl集团股份有限公司 移动机器人路径规划和避障方法及系统
CN105955262A (zh) * 2016-05-09 2016-09-21 哈尔滨理工大学 一种基于栅格地图的移动机器人实时分层路径规划方法
CN106647769A (zh) * 2017-01-19 2017-05-10 厦门大学 基于a*提取引导点的agv路径跟踪与避障协调方法

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0546633A2 (en) * 1991-12-11 1993-06-16 Koninklijke Philips Electronics N.V. Path planning in an uncertain environment
US20060020369A1 (en) * 2004-03-11 2006-01-26 Taylor Charles E Robot vacuum cleaner
US20050216182A1 (en) * 2004-03-24 2005-09-29 Hussain Talib S Vehicle routing and path planning
JP2008157698A (ja) * 2006-12-22 2008-07-10 Internatl Business Mach Corp <Ibm> 経路探索方法、プログラム及びシステム
US9069354B2 (en) * 2012-07-19 2015-06-30 Center Of Human-Centered Interaction For Coexistence Method for planning path for autonomous walking humanoid robot
US20140100693A1 (en) * 2012-10-05 2014-04-10 Irobot Corporation Robot management systems for determining docking station pose including mobile robots and methods using same
CN103529843A (zh) * 2013-10-17 2014-01-22 电子科技大学中山学院 Lambda*路径规划算法
CN103971008A (zh) * 2014-05-19 2014-08-06 浪潮电子信息产业股份有限公司 改进的启发式a*算法
CN105425801A (zh) * 2015-12-10 2016-03-23 长安大学 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN205306899U (zh) * 2015-12-30 2016-06-15 广东石油化工学院 一种室内slam险情检测与监控一体化智能清洁机器人
CN105955262A (zh) * 2016-05-09 2016-09-21 哈尔滨理工大学 一种基于栅格地图的移动机器人实时分层路径规划方法
CN105955280A (zh) * 2016-07-19 2016-09-21 Tcl集团股份有限公司 移动机器人路径规划和避障方法及系统
CN106647769A (zh) * 2017-01-19 2017-05-10 厦门大学 基于a*提取引导点的agv路径跟踪与避障协调方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
HAI LIN 等: "HIERARCHICAL HYBR旧SYMBOLIC ROBOT MOTION PLANNING AND CONTROL", 《ASIAN JOURNAL OF CONTROL》 *
JIADONG LI 等: "RRT-A* Motion Planning Algorithm for Non-holonomic Mobile Robot", 《SICE ANNUAL CONFERENCE 2014》 *
宋丹一: "改进A*算法在钢铁企业安全巡检机器人路径规划的研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
徐晓东: "移动机器人几何-拓扑混合地图构建及定位研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
徐跃: "基于超声波测距的机器人定位与避障", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
李晓辉: "基于多NAO机器人的路径规划与搬运研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
柴剑: "智能扫地机器人技术的研究与实现", 《中国优秀硕士学位论文全文数据库信息科技辑》 *

Cited By (41)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109871013A (zh) * 2019-01-31 2019-06-11 莱克电气股份有限公司 清洁机器人路径规划方法及系统、存储介质、电子设备
CN109871013B (zh) * 2019-01-31 2022-12-09 莱克电气股份有限公司 清洁机器人路径规划方法及系统、存储介质、电子设备
CN109828587A (zh) * 2019-03-08 2019-05-31 南京康尼智控技术有限公司 一种避障系统及避障方法
CN109901577A (zh) * 2019-04-04 2019-06-18 杭州向上机器人科技有限公司 一种用于机器人的控制系统
CN110081312B (zh) * 2019-05-07 2020-04-28 核芯互联(北京)科技有限公司 一种油田管道伴热控制系统
CN110081312A (zh) * 2019-05-07 2019-08-02 核芯互联(北京)科技有限公司 一种油田管道伴热控制系统
CN110281233B (zh) * 2019-05-13 2022-08-26 深圳创动科技有限公司 机器人、机器人控制系统和运动控制方法以及存储介质
CN110281233A (zh) * 2019-05-13 2019-09-27 深圳创动科技有限公司 机器人、机器人控制系统和运动控制方法以及存储介质
CN110138030A (zh) * 2019-05-13 2019-08-16 深圳创动科技有限公司 机器人及其充电控制方法以及存储介质
CN110142782A (zh) * 2019-06-14 2019-08-20 武汉创现科技有限公司 一种用于床面杀菌的机器人及其智能遍历床面的方法
CN110398964A (zh) * 2019-07-16 2019-11-01 浙江大学 一种低能量损耗机器人全覆盖路径规划方法及系统
CN110456789A (zh) * 2019-07-23 2019-11-15 中国矿业大学 一种清洁机器人的全覆盖路径规划方法
CN110443175A (zh) * 2019-07-29 2019-11-12 苏州维众数据技术有限公司 基于分离式视觉检测的清洁机器人控制系统及控制方法
WO2021068150A1 (en) * 2019-10-10 2021-04-15 Huawei Technologies Co., Ltd. Controlling method of mobile apparatus and computer program thereof
CN112955842A (zh) * 2019-10-10 2021-06-11 华为技术有限公司 移动装置的控制方法及其计算机程序
CN111281272A (zh) * 2020-02-20 2020-06-16 湖南炬神电子有限公司 一种用坐标实现扫地机规划清扫的方法
CN111203899A (zh) * 2020-03-13 2020-05-29 佛山科学技术学院 一种教育机器人及其控制系统
CN111580514A (zh) * 2020-05-07 2020-08-25 中国船舶重工集团公司第七一六研究所 基于联合编队的移动机器人最优路径覆盖方法
CN111708368A (zh) * 2020-07-07 2020-09-25 上海工程技术大学 一种基于激光与视觉slam融合的智能轮椅
CN111708368B (zh) * 2020-07-07 2023-03-10 上海工程技术大学 一种基于激光与视觉slam融合的智能轮椅
CN111813124A (zh) * 2020-07-22 2020-10-23 浙江迈睿机器人有限公司 一种基于拓扑地图的移动机器人混合调度方法
CN111813124B (zh) * 2020-07-22 2022-08-19 浙江迈睿机器人有限公司 一种基于拓扑地图的移动机器人混合调度方法
WO2022104796A1 (zh) * 2020-11-23 2022-05-27 深圳元戎启行科技有限公司 用于智能行动的多域控制器、控制系统和控制方法
CN112198883A (zh) * 2020-12-09 2021-01-08 苏州光格设备有限公司 一种用于巡检机器人系统的轨道分段标定方法
CN112880113A (zh) * 2021-01-22 2021-06-01 昆明理工大学 一种室内污染净化智能移动多功能装置及净化方法
CN113017492A (zh) * 2021-02-23 2021-06-25 江苏柯林博特智能科技有限公司 一种基于清洁机器人的物体识别智能控制系统
CN114281071A (zh) * 2021-04-13 2022-04-05 南京天之博特机器人科技有限公司 一种ros ai-iot智能自主导航机器人的控制系统
CN113180557A (zh) * 2021-04-25 2021-07-30 珠海格力电器股份有限公司 设备重定位作业恢复方法、装置、计算机设备和存储介质
CN113907647A (zh) * 2021-10-13 2022-01-11 广东小伊室集智能科技有限公司 扫地机发光控制系统
CN113985881A (zh) * 2021-10-29 2022-01-28 温州大学 一种基于双向爬虫的移动机器人路径规划方法
CN113884574A (zh) * 2021-11-03 2022-01-04 河南理工大学 基于slam的智能测路面纵断面平整度仪
CN113884574B (zh) * 2021-11-03 2024-03-19 河南理工大学 基于slam的智能测路面纵断面平整度仪
WO2023115660A1 (zh) * 2021-12-22 2023-06-29 广东栗子科技有限公司 自动清洁地面的方法及装置
CN114322279A (zh) * 2022-01-07 2022-04-12 深圳市丰用实业集团有限公司 一种家居空气智能净化系统及方法
CN114800507A (zh) * 2022-04-27 2022-07-29 北京龙诚智航科技有限公司 一种主从式机械臂控制系统
CN115041483A (zh) * 2022-06-13 2022-09-13 合肥仁洁智能科技有限公司 一种清扫机器人及其控制方法
CN114947664A (zh) * 2022-06-22 2022-08-30 汇智机器人科技(深圳)有限公司 一种应用于扫地机器人激光指引的控制方法、系统
CN116027794A (zh) * 2023-03-30 2023-04-28 深圳市思傲拓科技有限公司 一种基于大数据的泳池机器人自动定位管理系统及方法
CN116107321A (zh) * 2023-04-13 2023-05-12 无锡科技职业学院 基于视觉与激光雷达融合的无人车路径规划系统及方法
CN117031986A (zh) * 2023-10-10 2023-11-10 江苏通创现代建筑产业技术研究院有限公司 一种建筑幕墙自动化清洁的控制方法及系统
CN117031986B (zh) * 2023-10-10 2023-12-15 江苏通创现代建筑产业技术研究院有限公司 一种建筑幕墙自动化清洁的控制方法及系统

Also Published As

Publication number Publication date
CN109144067B (zh) 2021-04-27

Similar Documents

Publication Publication Date Title
CN109144067A (zh) 一种智能清洁机器人及其路径规划方法
CN105425801B (zh) 基于先进路径规划技术的智能清洁机器人及其清洁方法
CN108507578B (zh) 一种机器人的导航方法
US11400595B2 (en) Robotic platform with area cleaning mode
US10328573B2 (en) Robotic platform with teach-repeat mode
US20200047337A1 (en) Robotic platform with event based mode change
US20200047343A1 (en) Remote planning and locally adaptive service mapping
US20180364045A1 (en) Robotic platform with mapping facility
CN102138769B (zh) 清洁机器人及其清扫方法
KR101372482B1 (ko) 이동 로봇의 경로 계획 방법 및 장치
US20180361585A1 (en) Robotic platform with multi-function service module
US7085624B2 (en) Autonomous machine
CN108143364A (zh) 一种自移动清洁机器人清洁地图区域划分的方法
CN109602356A (zh) 一种清洁机器人、智能补水方法及补水站
CN110403528B (zh) 一种基于清洁机器人提高清洁覆盖率的方法和系统
CN107357297A (zh) 一种扫地机器人导航系统及其导航方法
CN110091326A (zh) 移动机器人以及移动机器人的控制方法
US20180361584A1 (en) Robotic platform with long-term learning
CN108762273B (zh) 一种清扫方法
US20180361581A1 (en) Robotic platform with following mode
CN106970623A (zh) 智能清洁装置及其网格路径作业方法
CN107184156A (zh) 一种智能扫地机器人
CN105700531A (zh) 基于自定义地图的家用两层工作扫地机器人及其扫地方法
WO2014135008A1 (zh) 一种沿边导航向中扩展的清洁机器人的清洁方法
CN106200671A (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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20211224

Address after: 908, block a, floor 8, No. 116, Zizhuyuan Road, Haidian District, Beijing 100089

Patentee after: ZHONGZI DATA CO.,LTD.

Patentee after: China Highway Engineering Consulting Group Co., Ltd.

Address before: 710064 middle section of South Second Ring Road, Beilin District, Xi'an City, Shaanxi Province

Patentee before: CHANG'AN University