《扫地机器人的路径策略.doc》由会员分享，可在线阅读，更多相关《扫地机器人的路径策略.doc（39页珍藏版）》请在三一办公上搜索。
1、数学建模小组作业第10组组员：+ 扫地机器人的路径优化二一四年七月二十三日扫地机器人的路径策略【摘要】我们将扫地机在房间内扫垃圾的路径策略问题抽象为方格化模型，用原始给定数据做出垃圾指标矩阵Q300*251,根据扫地机需要的行走路径进行程序嵌套，并用线性规划的方法来进行最优解的求取，然后根据建立的模型，用Matlab进行仿真演示。最终可以观察到扫地机在每种情况下的清扫路径。由于墙角也会存在垃圾，因此一般情况下我们不能实现100%的清扫，所以我们在此规定清扫完95%的区域即作为合格的条件。下面我们根据题目要求进行如下考虑：问题一经过分析我们可以将整个清扫区域划分成如图4.1.1所示的小区域，通过
2、运用矩阵整合函数，将矩阵Q300*251整合成一维数组T5，经过固定时间间隔的扫描判断T（1），T(2),T(3),T(4),T(5)MAX所对应的区域，在区域边沿随机选取坐标作为运行起始点，如果检测到的最大的元素的所在区域发生了变化，则根据当前位置与随机选好的碰撞点进行路径转移，按照这种方式运行，直到达到扫地机的结束条件停止。问题二这时扫地机每次只选择垃圾总指标最多的路径，并且每次扫描发生在扫地机与墙壁发生碰撞的时。扫描过后，机器人可以任意选择方向，选择方向的合适程度将成为扫地机扫地效率的关键，所以我们设定某一点作为扫地机扫描的起点每次碰撞时的扫描决定下一时刻可能的转弯方向，即某个方向上的垃
3、圾总指标Ck最大的即为下一时刻的转弯方向。问题三设计智能扫地机路径，保证扫地机以最短时间达到清扫要求，我们可以选取以下两种优化方向：（1）避免与墙壁进行碰撞，提高机器的灵活性；（2）提高单位长度上清扫垃圾指标总量，即提高清扫效率。比较问题1与问题2问题1中的方案存在其合理性，问题2中则显得较为高效，比较两者发现：改变ST大小可以改变地段扫地机性能。关键词： 线性规划 路径转移 划分区域 清扫效率目 录一、 问题重述 3二、 模型假设 4 三、 符号说明 4四、 模型建立与求解 44.0 问题分析 4 4.0.1 基本模型54.1 问题一：低端扫地机的工作路径 6 4.1.1 模型:分区扫描模型
4、 64.2 问题二：智能扫地机的工作路径 10 4.2.1模型：实时扫描模型114.3 问题三：扫地机的优化路径 13 4.3.1 模型：实时扫描折线模型 13 4.4 模型I与模型II的比较 17五、 模型的检验18六、 模型的评价18参考文献20附录21一、 问题重述1.1问题背景随着科学技术的不断发展，扫地机逐步走入平常百姓家，并被越来越多的人所接受，扫地机（也称扫地机器人）将在不久的将来像白色家电一样成为每个家庭必不可少的清洁帮手。产品也会由现在的初级智能向着更高程度的智能化程度发展，逐步取代人工清洁。扫地机是通过电动机的高速旋转，在主机内形成真空，利用由此产生的高速气流，从吸入口吸进
5、垃圾。扫地机一般为半径0.2米圆盘，、运行速度一般在每秒0.25米左右，只走直线，且碰到墙壁等障碍才可转弯。与传统的扫地机不同，智能扫地机可以通过微处理器进行现场环境分析，自动选择运行路线。遇到障碍发生碰撞后将重新随机地选择路线，逐步进行清扫。智能扫地机具有记忆、存储功能。利用传感器扫描现场环境，设计运行路径并存储。一般不能100%的清扫指定区域（如墙角部分）。清扫后的垃圾装进机子尾部的集尘盒，再通过人工清倒垃圾。机器在工作电压不足时会自动回到充电站充电。1.2目标任务考虑图1的工作现场，其中点A（1,5）为扫地机充电站，区域的垃圾指标见附件1.不考虑再充电情况，有以下问题：问题一：有些低档的
6、扫地机因为价格低廉，智能程度不高。其工作时的路径选择方案是将现场分成若干区域（例如上下左右4个区域），并通过传感器间隔一段时间扫描现场一次，选则垃圾最多区域清扫。假设每次扫过的区域垃圾指标值减少1。针对附件1，估计清扫完给定区域大致需要的时间（尽量保证每个点的垃圾指标不超过1）。 问题二：智能程度高的扫地机每次可以选择清扫垃圾指标值最大的地方清扫，每次扫过的区域垃圾指标值减少1。该机器人需多长时间才能保证清扫完该区域（区域内指标值不超过1）。比较问题1与问题2，说明问题1中方案的合理性。 问题三：其他条件同2，如何设计扫地机的路径，保证扫地机以最短时间清扫完该区域。 二、 模型的假设1、 假设
7、扫地机有充足的电量行驶完全部的轨迹，并且不会发生任何障碍；2、 假设路面平坦，不会产生较大程度的偏移或者是翻转；3、 假设高端的和低端的扫地机有鲜明的特点，并严格按自己的特点运行；4、 假设扫地机扫过单元格一半及以上的面积时，单元格内的垃圾指标减少1；5、 假设题目中给的点A始终为扫地机工作的起点；6、 假设由于种种环境因素不会对扫地机速率产生比较大的影响；7、 假设扫地机工作时没有人为的影响改变扫地机的轨迹；8、 假设当每个点的垃圾指标不超过1时扫地机的清扫任务结束；9、 假设扫地机在扫描的过程中没有额外的占用移动时间，即扫描时间不会影响最终的运动时间。三、 符号说明Y(251，100) 初
8、始垃圾指标矩阵J(251，300) 程序中的垃圾指标矩阵（a,b） 发生碰撞时刻参考点坐标（A,B） 下一次发生碰撞时刻参考点坐标ST 间隔扫描行驶路程S 从（a，b）到（A,B）扫地机行驶的路程T(n) 从充电点到第n个碰壁点扫地机行驶的时间CK 经过路径的垃圾总指标PK 经过路径的垃圾指标分布律四、 模型的建立与求解4.0问题分析由问题重述可知，智能的扫地机（不管是低档还是高档）都会按0.4米的宽度以0.25米每秒进行直线运行，并且路径上都选择与墙壁碰撞后扫描计算出的垃圾指标最高点行驶，这是所有问题的共同点。4.0.1基本模型（1） 清扫区域直观图首先我们建立一个300*251的矩阵Q，并
9、将各个单元里的垃圾指标赋入与二位矩阵组合形成一个三维数组。如图4.0.1所示为将题目中给定的附录1导入矩阵Q后的垃圾指标空间分布图。（2） 清扫区域方格化由于扫地机只走直线，碰到墙壁后才会转弯，所以，扫地机与墙壁碰撞之后会有180o的方向选择。每个指向都对应着一个所在方向的垃圾总指标CK，其中k每个方向的路线标志。（3） 路径的线性规划扫地机从碰撞点到下一个碰撞点所扫过的路程如图4.0.2所示。我们将区域分割成300*251的矩阵，每个单元存储着垃圾指标值。通过判断点坐标是否在路径中来判断单元垃圾指标值是否减1.图4.0.1 垃圾指标分布图 图4.0.2 线性规划推导条件根据图示，可以得到以下
10、约束条件： 且 4.1问题一：低端扫地机的运行路径对于问题一，低端扫地机需要对区域进行分区且不能时刻扫描计算垃圾指标值，总是经过一段规定的时间后，才会重新规划路线，没有进行下次扫描，则在当前判断垃圾指数最高的区域随机清扫，我们需要将区域分成几个小的区域，低端扫地机在扫描后达到垃圾总指标最高的区域清扫，清扫随机选取。4.1.1模型：分区扫描模型（1） 区域的划分通过分析问题一的工作特点，我们得到了一个相对比较合理的分割方式，如图4.1.1所示，我们进行的是五等分的条形分割，这样的分割方式可以保证扫地机在扫垃圾指标值最大的分区过程中，路径不覆盖其他分区。图4.1.1 分区分析示意图（2） 间隔扫描
11、时间的确定在这里我们不妨把间隔扫描时间抽象为间隔扫描行驶路程考虑。设定参数间隔扫描行驶路程ST ，并给ST 赋初值（12.5m）。举个例子，假设发生碰撞时刻参考点坐标为(a,b)，扫地机下一次与墙壁发生碰撞时刻参考点的坐标为(A,B)，则从(a,b)到(A,B)扫地机行驶的路程S 有如下公式：（勾股定理）故充电点到第n个碰壁点扫地机行驶的时间T(n) （3） 模型的建立 在扫地机的行驶过程中，根据假设4的条件；根据区域所在的位置枚举出参考点可以到达的点（单元）。在这些点中随机选取一个作为下一次与墙壁的碰撞点。将这点与参考点相连，即为下一步可能的清扫路径。为了提高清扫的效率，我们选择清扫垃圾总数
12、量最多的路径。在这里我们引入一个参数C，称为经过路径的垃圾总指标值。根据我们所建立的模型可以列出公式： （其中为直线路径所经过单元的垃圾指标值；N为经过区域的单位总数）通过计算每条路径的C 值的大小，判断出最大的C 值所在路径的终点，进而得出碰撞后扫地的朝向。由题意，低端扫地机通过传感器间隔一段时间扫描现场一次，选择垃圾最多区域进行清扫。我们可以理解为它不能对区域进行实时扫描，且在下一次扫描之前清扫区域始终保持在前一次扫描所判断出的垃圾总指标最高的区域内进行清扫。为保证清扫路径保持在前一次扫描所判断出的垃圾总指标最高的区域内，我们已经给出了如图1.2 所示的区域分区方式。下面我们就路径规划的几
13、种情况给出如下规定。对于扫描发生在整个工作区域，当次扫描先于碰撞的情况回溯到上一次的路径选择，我们知道下一次扫地机与墙壁发生碰撞时参考点的坐标（下一条选择路径的起点坐标）即为上一条选择路径的终点坐标。下一条路径的起点坐标已经确定，下面我们来讨论由该起点引出的多条路径的优化选择方式。因为扫描发生在扫地机在区域内的行进途中，即扫描的过程先于碰撞，所以用于路径选择判断的数据为扫描时刻的数据。因此，我们可以建立一个矩阵保存各个单元的垃圾即时的指标值。碰撞先于扫描的情况对于低端扫地机来说，我们默认其只有在扫描后才能对区域的垃圾指标进行分析和计算垃圾总指标值最大的路径。相比于智能度比较高的扫地机，低端扫地
14、机不具有预测和推算的功能。对此，我们做出这样的规定：低端扫地机在上述情况中，将在最新一次扫描所判断出的垃圾指标值最大的区域中，随机选取特有边界上的一点作为下一条路径的终点进行清扫。综上所述，划分情况的要点是低端扫地机对区域进行扫描不是实时的，而是间隔一段时间。（4） 程序框图（5）运算结果与分析因为扫地机的清扫路径有一定的随机性，故同样的实例模型进行多次试验肯定会产生不同的清扫路径，所用时间的不同。为使结果更具有说服力，我们采用测取6 组数据取平均值的方法来计算。具体实验记录如表1通过Matlab 对实验进行可视化演示，得到表1、图4.1.2区域行驶路径示意和图4.1.3运行路程/m运行时间/
15、sST=12.5m1290.71331162.92374.61461498.53370.77761483.1平均值345.36851381.5表1 模型I数据记录图4.1.2 模型I扫地机区域行驶路径示意图图4.1.3 模型I区域完成清扫后垃圾分布完成清扫后垃圾分布的结果。根据实验结果，我们可以知道扫地机完成清洁工作的平均时间大约为23min，符合实际，认为是正确的。4.2问题二：智能扫地机的运行路径 智能程度高的扫地机具有实时扫描的功能，在每一个与墙壁碰撞的瞬间其都会重新扫描。所以如何设计机器人的清扫路线是本题的关键。扫地机每次与墙壁发生碰撞的瞬间，扫描整个区域计算出各个方向上的垃圾指标值，
16、并从中选择出一条垃圾总指标值最高的路径（路径的出发点为碰撞点）。由于机器人的转弯方向是任意的，如何简化问题使得机器人在有限的方向（0-180）上计算垃圾的总数是我们所需要考虑的。在这里我们把扫描此刻的碰撞点作为固定的参考点，连接碰撞点与除去碰撞点所在的墙壁以外的另外三面墙壁上的分割间断点，做出直线并计算各个直线上的垃圾总指标。比较各个方向上的垃圾总指标的大小，判断出最大值进而得出转弯方向。4.2.1模型：实时扫描模型(1）区域的划分首先我们建立一个251*300的矩阵，并将各个单元里的垃圾指标赋入与二位矩阵组合形成一个三维数组。由于机器人的半径为0.2 米（面积为/250.126 ），将区域分
17、成若干0.1*0.1 的方格。可以看出机器人可以覆盖大约16 个方格（0.4*0.4）。（2）时刻扫描的抽象处理方法根据问题重述我们可以知道智能扫地机可以通过微处理器进行现场环境分析，自动选择运行路线。遇到障碍发生碰撞后将重新随机地选择路线，逐步进行清扫。智能扫地机具有记忆、存储功能。利用传感器扫描现场环境，设计运行路径并存储。所以我们可以给出：智能程度高的扫地机扫描垃圾计算指标值的过程发生在与墙壁发生碰撞的瞬间；(3)模型II 的分析与建立 在扫地机的行驶过程中，我们做出这样的假设只要碰到某个（单元？方格？）就算是清扫到了该区域，即认为垃圾指标值减1。 优化路径选取 为了提高扫地机单位时间内
18、的清扫量，我们选择清扫垃圾总数量最多的路径。在这里我们引入一个参数C，称为经过路径的垃圾总指标值。根据我们所建立的模型可以列出公式，通过计算每条路径的C 值的大小，判断出最大的C 值所在路径的终点，进而得出碰撞后扫地的朝向。 最优化路径选取 在前面我们采取的优化路径选取方式是计算出垃圾总指标数最大的路径进行清扫。但是考虑到不同的路径有不同的长短，垃圾总指标数最大的路径不一定是效率最高的，即相同的时间内清扫的垃圾个数不一定是最高的。显然，以垃圾总指标数为路径选择判断的依据是不够优化的。于是，我们将引入经过路径的垃圾指标分布律Pk进行进一步优化的路径选择。（4） 运算思路框图（5） 运算结果与分析
19、 通过Matlab 对实验进行可视化演示，得到表2、图4.2.1 区域行驶路径示意和图4.2.2完成清扫后垃圾分布的结果。数据记录运行路程/m194.1670运行时间/s776.6680表2 实时扫描模型数据记录图4.2.1 实时扫描模型扫地机区域行驶路径示意图图4.2.2 实时扫描模型扫地机区域完成清扫后垃圾分布 根据实验结果，我们可以知道扫地机完成清洁工作的时间大约为13min，符合实际，认为是正确的。与传统的扫地机不同，智能扫地机实时可以通过微处理器进行现场环境分析，自动选择运行路线。4.3 问题三：扫地机的优化路径 关于设计扫地机的路径保证其以最短的时间清扫完该区域（问题三）的关键在于
20、提高单位长度上清扫垃圾指标的数量。4.3.1模型：实时扫描折线模型 与传统的扫地机不同，智能扫地机实时可以通过微处理器进行现场环境分析，自动选择运行路线。（1）区域的划分 同4.2.1(1）（2）时刻扫描的抽象处理方法 时刻扫描区域现场，参考点每移动一个单元都要进行实时的监控扫描。（3）模型III 的分析与建立优化路径选取 在模型II 中，我们选择C 最大的路径作为下一步的清扫路径。再深一步考虑，我们可以猜想到会有以下几种情况的发生。 存在两个以上的长度相等的路径同时为C 的最大值所在路径； 存在两个以上的长度不等的路径同时为C 的最大值所在路径； 存在一个长度较短的路径( l1)其垃圾总指标
21、为C1、一个长度较长的路径（l 2 ）其垃圾总指标为C2，而有的条件为了提高清扫的效率，我们选择单位长度上垃圾指标值最高的路径。在这里我们引入一个参数P，称垃圾指标分布律。根据我们所建立的模型可以列出公式：（其中mi为直线路径所经过单元的垃圾指标值；N为经过区域的单位总数） 通过计算每条路径的值的大小，判断出最大的值所在路径的终点，进而得出碰撞后扫地的朝向。计算出每个方向的并进行比较,判断出最大的方向并选定其为下一次路径。如题目要求，机器人每次经过一个单位，则该方格垃圾指标值减1，即矩阵中的相应元素减1。为了控制扫地机工作的结束，我们认为扫地机在每次与墙壁发生碰撞的瞬间都会计算此时所有单元垃圾
22、指标值是否都不大于1？直到碰到墙壁后计算出此时所有单元垃圾指标值都不大于 1 时，扫地机自行回到充电站并停止工作。否则再次进行判断继续向下一个值最大的路径行进。（4） 程序框图（5） 计算结果与分析 通过Matlab 对实验进行可视化演示，得到表3、图8.5.1 区域行驶路径示意和图8.5.2完成清扫后垃圾分布的结果。数据记录运行路程/m39.4065运行时间/s157.6260表3 实时扫描折线模型数据记录图4.3.1 模型优化后清扫垃圾路径示意图图4.3.2 模型优化后清扫垃圾示意图 根据实验结果，我们可以知道扫地机完成清洁工作的时间大约为3min，符合实际，认为是正确的。4.4 模型与模
23、型的比较 比较问题1 与问题2，说明问题1 中方案的合理性。数据比较分析模型I模型II运行路程/m345.3685194.1670运行时间/s1381.5776.6680从上面的分析可以看出，低端扫地机从性能上来讲要比智能扫地机差，但是低端机就必然有其存在的价值。也会有一定的优越性。两者的共性是完成扫地的时间相差不是很悬殊。从试用人群来讲低端扫地机相比于智能扫地机在价格上要低很多，大多数的消费者还是普通的收入水平，因此低端扫地机可以满足更多人的消费需求，更利于扫地机的普及以及推广。不同的人对清扫垃圾的指标有不同的要求，低端机综合以上两点，会在市场中占有一席之地。从耐用程度来讲低端机的扫描以及内
24、部的程序相对比较简单，而智能扫地机为实现其高度的智能化，扫描的过程及其程序要相对比较复杂。因此，在机器的维护上，低端机要比智能扫地机简单的多，假设两台机器配备相同的电池，智能扫地机由于要进行相对较频繁的扫描，以及对内部复杂程序的供电支持，因此智能机的耗电量要大一些，这个道理类似于手机当中的智能机与普通机。综合以上的分析，我们可以得出一个结论，低端扫地机的寿命要高于智能机的使用寿命。从开发编程着想通过对整个区域进行划分，即对区域内的单元进行分区，将多个单元合并成一个小区域进行考虑大大减少了运算是的数据总量，进而缩短运算运行时间，达到提高效率的目的。另外，一方面若是要提高低端扫地机的效用，可以通过
25、优化计算出最合理的扫描时间。进而达到缩短清扫时间的效果。五、模型的检验我们采取如图4.1.1所示的区域分割方式，这样的分割方式可以保证扫地机在扫垃圾指标值最大的分区过程中，路径不覆盖其他分区。认为是比较合理， 但是，不可否认这样的分割区域方式不是最合理的。通过 Matlab 对实验进行可视化演示，得到表 1、图4.1.2 区域行驶路径示意和图4.1.3 完成清扫后垃圾分布的结果。 根据实验结果，我们可以知道扫地机完成清洁工作的时间大约为23min，符合实际，认为是正确的，模型是正确的。再者又可得到表2、图4.2.1区域行驶路径示意和图 4.2.2 完成清扫后垃圾分布的结果。根据实验结果，我们可
26、以知道扫地机完成清洁工作的时间大约为 13min，符合实际，认为是正确的，即模型是合理的。 通过得到的表3、图4.3.1区域行驶路径图和图4.3.2完成清扫后垃圾分布的结果。根据实验结果，我们可以知道扫地机完成清洁工作的时间大约为3min，符合实际，认为是正确的。六、模型的评价在本文中，我们采用了区域抽象化、栅格和线性规划模型求解，并且通过Matlab软件仿真模型进行验证，具有以下优点： （1）采取区域抽象化，并采取一定的手段让问题透明化，使问题变得更简单，容易理解。 （2） 通过栅格模型，对问题进行具体化，使对问题的分析更明确和清晰。 （3）采用线性规划模型，使问题层次更鲜明，有利于问题的解
27、决。 不可否认，模型也存在着如下缺点： （1）扫地机栅格化之后，使得本该扫不到的地方（如墙角）也纳入清扫范围。这样的后果是使得清扫率的计算存在误差。但是，由于题设的要求是尽量保证每个点的垃圾指标不超过1， 我们可以认为误差是在允许的范围内的 。 （2）计算机器人行进过程中清扫到的区域时，由于机器人实际上是圆形的，而计算时以方格为单位，有一定的误差。参考文献1王仲民，移动机器人路径规划及轨迹跟踪问题研究，河北工业大学，2006年3月。2陈恩水、王峰，数学建模与实验，科学出版社，2008年6月第一版。3 毛保华.线性规划的若干算法研究D.2010.4智能扫地机器人工作原理解析，豆丁网，2014,7
28、.20.附录：MATLAB源代码：问题一：Y=C: %原数据矩阵J=zeros(251,300);for i=1:251 for j=1:100 J(i,(j*3-2):(j*3)=Y(i,j); end;end; %转换矩阵d1=zeros(5,5);for i=1:5 for j=1:5 d1(i,j)=10*j+60*(i-1)+10; end;end; %产生边界枚举点a=1;b=50; m=0; sumtime=0;sumtime1=0;sumline=0;MAX1=sum(sum(J)*0.02; %设定常数for v=1:1000 maxa=0; MAX=0; for k=1:5
29、 si=0; for i=1:251 for j=1:60 si=si+J(i,(j+60*(k-1); end; end; MAX=MAX+si; if simaxa maxa=si; m=k; end; end; %找出最优区域 for c=1:1000 b1=d1(m,fix(rand(1)*5)+1); if a=a if b1=b for x=1:251 for y=1:300 if(x=a & x=a1+20) if(y=b-20) if(y=(b1-b)*(x-a-20)/(a1-a)+b-20) if J(x,y)1 J(x,y)=J(x,y)-1; else J(x,y)=0
30、; end end end end end end else for x=1:251 for y=1:300 if(x=a & x=b1-20 & y=b) if(y=(b-b1)*(x-a1)/(a-a1)+b1-20) if J(x,y)1 J(x,y)=J(x,y)-1; else J(x,y)=0; end end end end end end end else if b1=b for x=1:251 for y=1:300 if(x=a1 & x=a+20) if(y=b-20) if(y=(b-b1)*(x-a)/(a-a1)+b-20) if J(x,y)1 J(x,y)=J(
31、x,y)-1; else J(x,y)=0; end end end end end end else for x=1:251 for y=1:300 if(x=a1 & x=b1-20 & y=b) if(y=(b1-b)*(x-a-20)/(a1-a)+b-20) if J(x,y)1 J(x,y)=J(x,y)-1; else J(x,y)=0; end; end; end; end; end; end; end; end; figure(1) line(a a1,b b1); hold on figure(2) imagesc(J); MAX2=sum(sum(J); a=a1; b=
32、b1; if sumtime50 %扫描间隔 sumtime1=sumtime1+sumtime; break; end; end; %在限定区域内随机选择路径 sumtime=0; if MAX2MAX1 %判断是否达标 break; end; MAX2=0;end; Sumtime1 Sumline问题二：Y=C: J=zeros(251,300);for i=1:251 for j=1:100 J(i,(j*3-2):(j*3)=Y(i,j); end;end;a0=200;b0=20;a=a0;b=b0;sum_time=0;sum_line=0;J2=zeros(251,300);
33、s=zeros(251,300); a1=0;b1=0; MAX=sum(sum(J)*0.02;for c=1:1000 if (a=1) for A=1:231 B=300; for x=1:251 for y=1:300 if( x=a ) if(y=b-20 & y=300) if(y=(B-b)*(x-a-20)/(A-a)+b-20) J2(x,y)=J(x,y); end; end; end; end; end; s(A,B)=sum(J2(:); J2=zeros(251,300); end; for B=b:300 A=231; for x=1:251 for y=1:300 if( x=a) if(y=b-20 & y=B) if(y=(B-b)*(x-a-20)/(A-a)+b-20) J2(x,y)=J(x,y); end; end; end; end; end; s(A,B)=sum(J2(:); J2=zeros(251,300); end; for B=20:b-1 A=231; for x=1:251 for y=1:300 if(x=a & x=B-20 & y=b) if(y=(b-B)
