清洁机器人的全覆盖路径规划研究Word文档格式.docx

1、按照机器人获取环境信息的方式不同大致分为三种不同类型：基于模型的路径规划；基于传感器信息的路径规划；基于行为的路径规划。室内地面清洁是一项枯燥乏味的重复性劳动,传统吸尘器工作时不仅需要人的参与,且操作安放不便、清洁效率低、效果差，实现清洁作业自动化与智能化是高效高质清洁的有效途径。智能扫地机器人是将移动机器人技术和吸尘器技术有机结合起来以实现室内环境半自主或自主清洁的一种环保、健康、智能型的服务性机器人。目前国内外在清洁机器人方面的研究还有许多关键技术问题需要解决和提高，其中路径规划就是重要的关键技术之一。本项目主要研究智能扫地清洁机器人在环境已知的情况下如何设计清扫路径，以达到在尽量短的时间

2、内将整个房间清扫干净，也就是在尽量短时间内机器人走遍房间的每一个位置的目的。问题要求：建立智能扫地机器人的路径规划模型，以实现区域覆盖率高、路径重复率低和时间花费少的目的。三、 基本假设与符号设置3.1基本条件假设1） 机器人清扫区域基本规则。2） 清扫区域的地面平整，只有凸出障碍物。3） 机器人行进过程均匀速。4） 机器人的清扫方式为固定式前向吸尘。5） 机器人清扫过程中无系统故障。6） 机器人清扫覆盖面的宽度与机身同宽。7） 机器人只能依次转向90度行走。3.2符号设置a:房间的长度。b:房间的宽度。d:机器人的清洁范围的半径。：无障碍区域的面积为有障碍物区域的面积为可行遍历轨迹丛四、问题

3、分析及模型建立4.1 问题分析清洁机器人作为现在广泛应用来取代手工劳动的工具，作好其路径规划具有相当重要的意义。机器人的路径规划不仅要考虑清洁机器人的工作效率和质量，同时也要考虑其对能源的有效使用。因此，笔者认为在满足清扫房间全区域覆盖的前提下，尽量满足清洁机器人移动的行进总路径最短是本文考虑的重点。其中，要满足全区域覆盖，在环境已知的前提下，我们通常采用遍历的算法来完成搜索。而遍历分为图的遍历和树的遍历，经分析后，在该模型中我们使用图的遍历。图的遍历分为广度优先遍历和深度优先遍历，因此我们分别计算在两种算法下的路径的结果，并将进行比较，择优而用。我们将按照下面几个步骤来对机器人的区域行进路径

4、进行规划，已达到遍历整个房间的目的：Step1：机器人对房间的环境进行测量。这里机器人可通过沿房间内壁环绕房间一周，记录房间大小。Step2：对房间进行栅格化；Step3：对栅格后的格子进行编码；Step4：确定目标函数；Step5： 随机选取几种情况下的障碍物跟房屋的构造关系，并作出相应的图；Step6：应用深度优先遍历和广度优先遍历求出路径跟目标函数值，通过比较两种算法下目标函数值的大小和观察其对应的图，确定哪种情况下使用哪种算法。4.2 模型建立4.2.1 房间栅格化 为了便于存储房间的信息，我们首先将房间进行栅格化。假设房间长为，宽为，清洁机器人机身直径为，则可将发其栅格化为（a/d+

5、1*（b/d+1）一个阶的矩阵格。这里为了能较好且方便地确定哪种遍历对房间搜索更优，我们先做低阶的路径规划实验，假设房间经栅格化后为一个4*4阶的矩阵格，对这个小房间的遍历比较而确定方法后，再将其推广，如图4.0。 图4.04.2.2 栅格编码 编号即编码，可采取二进制编码、十进制编码、ASCII编码等等。在这里，我们采用十进制编码，直观且便于编程使用。对栅格编码的方式也多种多样，比如，对未遍历的栅格编号为0，遍历过的栅格编号为1，障碍物所在栅格编码为2。由于编程实现不受编码方式的影响，故在本文中，我们用116这16个实数从房间最上端依次对每个栅格进行编号，可采取图4.1型的编号方式。1234

6、5678910111213141516 图4.14.2.3 目标函数的确定 该模型建立的前提是遍历整个房间，达到覆盖率为百分之百的目的。于是在满足全区域覆盖的前提下，保证清洁机器人行进的轨迹最短和重复率最低便成为本次建模的最终目的。从而，目标函数可确定为求最短路径和最低重复率。4.2.4 随机选取房间里障碍物的几种情况 为了能更好地观察深度优先遍历和广度优先遍历在不同障碍物摆设情况下目标函数的变化趋势，我们需设计几种不同障碍物摆设情况。假设房间中障碍物有13个，在这里：障碍物面积小于一个栅格时记为一个栅格的大小，大于一个栅格小于两个栅格记为两个栅格的大小，以此类推。对每种个数的障碍物分别以障碍

7、物在墙角，在墙边和在中间3种方式构造出九种障碍物和房间的关系。如图4. 2到图4.10五、模型求解与分析5.1 模型求解下图为深度优先遍历和广度优先遍历遍历对比表，通过编程实现，得出以下九种情况在两种算法中得到的路径、路径长度和重复率（注：下表中路径一栏数据以此表示）为：深度优先遍历广度优先遍历图4.21-2-3-4-8-12-16-15-14 -10-11-7-6-5-9-14-图4.313-1/15图4.4172/15图4.5-1/14图4.6206/14图4.72/14图4.84/13图4.91/13图4.10 图5.1说明：广度优先遍历中的省略号代表相邻两个栅格之间不能直接到达。箭头代

8、表行进方向，如：即可在栅格中表示为： 图5.25.2 模型分析从图5.1可以很直观地看出利用深度优先遍历和广度优先遍历对房间进行搜索的路径、路径长度和重复率。但由于广度优先遍历所得路径中很多邻接点之间，清洁机器人并不能直接到达，若采用回溯法到达邻接点将会造成行进路径重复，不仅增加了路径长度，而且重复率很高，不能达到高效、节能的目的。因此，我们初步选择深度优先遍历对房间进行搜索。观察统计在几种障碍物下深度优先遍历所得目标函数值的大小和变化趋势，容易知道房间随着障碍物的增加重复率也在不断增大，同时障碍物在房间中的布局也影响着目标函数值的大小。从图5.1和障碍物布局图可发现障碍物越多越靠近中央目标函

9、数值越大，即清洁机器人的行进轨迹越长，重复率越高。但无论是哪种布局，采用深度优先遍历都比广度优先遍历优越。故我们选择深度优先遍历作为最终的搜索方式。六、模型推广在第五部分，我们仅仅做了一个小实验，是在假设栅格化后房间为一个4*4阶的矩阵格的前提下寻找最优算法。现在我们需将其还原成现实中的房间，采用深度优先遍历对房间进行搜索。按照第五部分中栅格化房间的方法将实体房间进行栅格化。上述，我们采用实数编码的方式对每个栅格进行了编号。只是为了我们自己能清楚明了地知道清洁机器人行进的轨迹，但在现实生活中清洁机器人打扫房间并不需要知道每一个格子的编号，所以我们在进行编号时完全不用采用上述实数编码的方式。我们

10、可假设清扫区域的面积为，无障碍区域的面积为，有障碍物区域的面积为。令；且 建立目标函数：利用下面编程思想：在已栅格化的区域，清洁机器人从区域最顶端开始按深度优先遍历的算法搜索标记为“0”的区域，搜索过的栅格用“2”进行标记，当遇到障碍物“1”时，按优先级为右，下，左，上的方式确定下一步的搜索方向（对平面地图来说），当机器人在任何一个方向上都无法前行的时候，进行回溯直至遍历完整个区域进行编程，最后确定机器人的行进轨迹。七、模型评价与推广7.1 模型评价本模型采用由小到大的推广方式给出模型，最初采用选取一个小型栅格区域，随机选取几种障碍物布局，对两种遍历算法进行实验，找出了更优的搜索算法，最后将其

11、推广到现实中很大的栅格化区域，需要注意的是，在现实生活中，清洁与障碍物的面积比值并没有我们假设设模型中那样紧密，所以机器人在实际清扫时的活动更为简便，因此我们的模型推广，可以说是由复杂到简单，但是其前提是清洁区域已满足了我们的基本条件假设的范畴，当然采用低阶的区域栅格化模型，是使读者更好地理解此算法。同时，本文将区域转化为图的形式，利用图中深度优先遍历算法对区域进行搜索，算法简单，容易实现，又能够将整个清扫区域全部遍历完，这有着较强的理论支撑，相比于随机遍历更具有规律性、时效性。但该模型也存在着一些缺点，主要有下列一些不足之处：1. 清洁机器人清扫环境是已知，为静态的；2. 清洁区域的障碍物基

12、本规则，且面积需要满足为清洁机器人清扫面积的近似取整的整数倍；3. 重复率一般情况下比自主适应较高的清洁方式高。7.2 模型延展 一般情况下。该模型在现实中适合空间相对障碍足够大的模型，如用于障碍太多那么该模型会出现重复率较高的情况，故在实际应用中对能源要求太高，不能达到节能的目的，不能完全满足人们的需求。同时，由于对环境要比较高所以并不适合在动态环境下使用，而混沌法在具有搜索动态环境的领域有很强的作用，如果将两者结合起来，便可以得到一个更优越的路径规划模型。八、参考文献1 罗胜.吸尘机器人的现状及其智能系统的若干关键技术J.传感器与为系统，2007年第26卷第11期.2 蒋玉杰，曾岑.清洁机

13、器人基于遗传的全区域路径规划J.2009（05）.3 刘海，郭小勤，余得贵.清洁机器人全覆盖路径规划算法综述J.机电产品开发与创新，2008年11月第21卷第8期.4 石鸿雁，孙昌志.一种基于混沌优化算法的机器人路径规划方法J.机器人，2005年3月第27卷第2期.5 李兵，蒋慰孙.混沌优化方法及其应用J.控制理论与应用，1998年8月第14卷第4期.6 王凌，郑大钟，李清生.混沌优化方法的研究进展J.计算机技术与自动化，2001年3月第20卷第1期.7 王改云，马姝靓.典型混沌系统的matlab仿真实现J.中国科技信息2008年第3期.8 遗传算法. XX百科，9 姚俊峰，梅炽，彭小奇.混沌

14、遗传算法（CGA）的应用研究及其优化效率评价J.自动化学报，2002年11月第28卷第6期.10 徐宗本，张讲社，郑亚林.计算智能中的仿生学：理论与算法.北京：科学出版社，2003.5.11 马云红，周德云.一种无人机路径规划的混沌遗传算法.西北工业大学学报，2006年8月第24卷第4期.12 基于Matlab的遗传算法解决TSP问题EB/OL.13 王科俊，徐晶，王磊，张燕.基于可拓遗传算法的机器人路径规划J.哈尔滨工业大学学报，2006年7月第38卷第7期.13 陈晶.基于遗传算法的避障TSP问题算法设计J.研究与开发，2005（10）.14 陈尔奎，曹志强，谭民.移动机器人路径规划策略J

15、.南京理工大学学报，2005年10月第29卷增刊.15 孔峰，陶金，谢超平.移动机器人路径规划技术研究J.广西工学院学报，2009年12月第20卷第4期.16 张捍东，郑睿，岑豫皖.移动机器人路径规划技术的现状和展望J.系统仿真学报，2005年4月第17卷第2期，439-443.17 张佳，陈杰，窦丽华.基于路径规划的智能机器人控制实验J.实验技术与管理，2010年12月第27卷第12期.18 刘松，李志蜀，李奇.机器人全覆盖最优路径规划的改进遗传算法J.计算机工程与应用，2009年4月5日，245-248.19 马兆青，袁曾任.基于栅格方法的移动机器人实时导航和避障J.机器人，1996年11月.20 纪晓华，杨鹏，唐鸿儒.轮式移动机器人路径规划的遗传进化算法J.淮海工学院学报，2002年12月第11卷第4期.21 遗传算法与路径规划. 22 张超群，郑建国，钱洁.遗传算法编码方案比较J.计算机应用研究，2011年3月第28卷第3期.23 Anany Levitin.算法设计与分析基础（第2版）.清华大学出版社，2011年7月.24 严蔚敏，吴伟民.数据结构（C语言版）.清华大学出版社.2010年2月.附录：