《室内巡视机器人设计和仿真实现毕业设计n.doc》由会员分享，可在线阅读，更多相关《室内巡视机器人设计和仿真实现毕业设计n.doc（41页珍藏版）》请在三一办公上搜索。
1、本科毕业设计（论文）题目：（中文）室内巡视机器人设计和仿真实现（英文）Indoor patrol robot design and simulation 学 院 专 业 班 级 学 号 姓名 指导教师 职称 完成日期 诚 信 承 诺我谨在此承诺：本人所写的毕业论文室内巡视机器人设计和仿真实现均系本人独立完成，没有抄袭行为，凡涉及其他作者的观点和材料，均作了注释，若有不实，后果由本人承担。 承诺人（签名）： 年 月 日室内巡视机器人设计和仿真实现【摘要】巡视机器人是一个集环境感知、路线规划、动态决策、行为控制等功能集于一体的综合系统，采用巡视机器人进行定点监控巡视或不间断自动巡视将是目前一种可行
2、的解决方案。将机器人用于巡视工作，具有广阔的应用前景。本文以自主移动机器人为平台，主要任务与目标是在Robotic Studio仿真系统中建立差分驱动轮式移动机器人进行巡视仿真环境，通过获取激光数据和摄像头数据来完成路径规划，避障和实时监控，设计手动控制界面来手动控制机器人进行巡视。【关键词】移动机器人；路径规划；避障；巡视；仿真； 【Abstract】With the constantly expanding the size and number of social and economic development, supermarkets, airports, railway stat
3、ions, exhibition centers and logistics warehouses and other large-scale flow of passengers and places, large and medium-sized cities of high-level, high-end commercial buildings, an increasing number, the automation needs of the increasingly urgent. The patrol robot is a set of environmental percept
4、ion, route planning, dynamic decision-making, behavior control functions into one integrated system, patrol robot sentinel surveillance visits or continuous automatic inspection will be a viable solution. The robot for the inspection work has broad application prospects. In this paper, the autonomou
5、s mobile robot platform, the main task and goal differential drive wheeled mobile robots in the Robotic Studio simulation system to conduct an inspection of the simulation environment, by acquiring laser data and camera data path planning, obstacle avoidance and real-time monitoring design manual co
6、ntrol interface to manually control the robot to conduct an inspection.【Key words】Mobile Robot；Path Planning ；Obstacle Avoidance；Inspections；Simulation；目录1绪论11.1引言11.2移动机器人的研究内容及发展趋势11.2.1移动机器人的国内外研究现状11.2.2移动机器人的发展趋势21.3论文的主要内容22室内巡视机器人设计的总体方案32.1研究任务32.2仿真机器人的组成32.2.1激光传感器32.2.2摄像头32.2.3差分驱动轮42.3室
7、内巡视机器人的开发环境52.3.1仿真环境Microsoft Robotics Developer Studio 2008 R352.3.2编程环境visual studio 200862.4仿真机器人的总体巡视方案62.4.1总体巡视方案62.4.2传感器数据接口62.4.3避障62.4.4路径规划72.4.5实时监控72.4.6手动控制73仿真机器人巡视算法及实现83.1仿真环境建立及编程调试83.1.1仿真环境建立83.1.2控制程序的编写83.2避障103.2.1获取激光数据103.2.2避障的实现113.2.3避障程序123.3路径规划143.3.1机器人沿墙巡视的设计153.3.2
8、最小二乘原理153.3.3直线拟合163.3.4机器人沿墙走巡视的设计163.3.5机器人沿墙走巡视的实现183.3.6机器人沿墙走巡视的特殊情况203.4实时监控203.4.1获取摄像头数据203.4.2图像显示及刷新223.5手动控制器的设计243.5.1手动操作面板控制原理253.5.2手动操作面板控制的功能253.5.3手动控制器的实现264实验结果284.1数据输出程序284.2数据分析284.2.1避障时数据分析284.2.2沿墙走时数据分析294.3总结315总结与展望325.1本文总结325.2展望32参考文献33致谢351 绪论1.1 引言21世纪，随着经济，科技，社会不断向
9、前进步和发展，我们生活中的各种各样的的人流以及物流的集散场所不断的增加，其数量与规模是以往所不能比拟的，例如仓库、车站，大型购物中心，高级写字楼、会议中心以及飞机场等等。正是由于这些人流，物流集散场所在数量和规模上的不断增加，随之而来的是这些场所中各种设备、装置的自动化需求也越来越高。然而巡视机器人，它是一个集环境感知、路线规划、动态决策、行为控制等功能集于一体的综合系统，采用巡视机器人进行定点监控巡视或不间断自动巡视将是目前一种可行的解决方案。将机器人用于巡视工作，具有广阔的应用前景，近年来已受到国内外的重视，成为服务机器人的一个新研究方向。本文主要综述室内巡视机器人设计的相关问题，并进行问
10、题分析及提出相关的解决方案。1.2 移动机器人的研究内容及发展趋势1.2.1 移动机器人的国内外研究现状 国外移动机器人的研究开展较早，斯坦福研究院从1966年开始并用了6年时间研制出了“Shakey”的移动机器人。目前研究的方向主要是人工智能技术，即在复杂环境下机器人能够进行自主推理、规划和控制，并且它还安装有视觉、距离和碰撞等传感器，可以通过计算机对采集的图像进行处理和任务规划等功能。70年代，美国加州理工大学研制的移动机器人和法国LAAS的机器人和人工智能研究小组开发的Hiare移动机器人，是当时移动机器人研究领域的代表之作。80年代，美国国防高级研究计划局揭开了世界范围内全面研究移动机
11、器人的序幕。其代表是MIT研发的Wheelesley机器人。90年代，移动机器人进入更高层次的研究领域，其研究的主要内容在于研发出高水平的环境信息传感器、信息处理技术、高适应性的移动机器人控制技术和真实环境下的规划技术等。美国Probotics公司1999年生产了Cye小型家用移动机器人，它采用双轮差动驱动方式，可以自主的进行相应的工作。 国内移动机器人的研究起步较晚，但通过对国外机器人平台的引进和自主开发，现已取得很大进展。很多高校和研究机构对移动机器人各方面的功能展开了广泛的研究。1.2.2 移动机器人的发展趋势虽然，在目前欧美一些国家和日本在移动机器人研究领域取得很大的进步，并领先于其他
12、国家，但是其相应的成本也是相当高昂的。因此结台我国的基本国情，且考虑到移动机器人的市场等相关因素，我们必须在以下几个方面上进行努力： (1)必须降低成本，研发出能够满足不同功能需求的相关系列产品。 (2移动机器人未来的发展方向是智能化和自主式。 (3)保证移动机器人能够正常巡视并正确的呈现出当前环境的具体状况。 (4)必要时我们可以通过人机结台，运用无线通信技术和因特网技术对移动机器人系统进行控制，来处理一些突发、紧急情况，保证移动机器人的正常工作。1.3 论文的主要内容本论文的主要内容是在Robotic Studio仿真系统中建立差分驱动轮式机器人的室内巡视仿真环境，通过编写程序对激光传感器
13、数据的采集和处理，规划机器人的运动路径及避障，使其能够自主巡视，再将摄像头采集到的图像显示出来，进行实时监控，然后在设计一个手动控制功能，即手动控制机器人进行巡视。课题的主要工作如下：1.学习和了解Robotic Studio仿真系统，掌握建立机器人仿真环境和编程控制机器人的基本方法；2.学习和了解差分驱动轮式移动机器人的基本运动控制方式；本文中我们要求机器人完成的动作都是在改变机器人左右轮子的速度来实现的，所以我们的重点是掌握机器人左右轮速度的控制上。3.通过编程实现机器人沿墙进行自主巡视及实时监控；其中涉及到机器人移动的路径规划，避障，摄像头数据获取，图像显示，图像实时刷新等问题。4. 通
14、过编程来实现对机器人进行手动控制进行巡视；虽然自动巡视具有很多的优点，如方便，快捷，自主等，但是也有些不足，比如操作不灵活，功能单一等。为此我们专门引入了手动控制器来增加操作的灵活性和多样化的功能。5.在Robotic Studio仿真系统中编程实现机器人在室内进行巡视。机器人能够沿着墙壁进行自动巡视，实时监控，躲避障碍物，还要能够进行手动控制，是机器人进行手动巡视。2 室内巡视机器人设计的总体方案 2.1 研究任务本文的研究任务主要为机器人的自动巡视和手动控制巡视两部分，其中包括路径规划，避障，实时图像显示等内容。寻找一种合理，有效，方便，成熟的方法来到达我们所要求的设计要求，是机器人在室内
15、的巡视效果到达最佳。2.2 仿真机器人的组成本次研究中所使用的仿真机器人是采用轮式结构，由2个驱动轮和一个辅助轮组成，此外还安装有激光传感器，摄像头。2.2.1 激光传感器本文中所用的仿真激光传感器是按照德国SICK公司生产的LMS200设计的，它的扫描范围最大可以到达8m，扫描角度为180，而将这个180的半圆分成0360共361份，其角度分辨率为0.5一份。如图2.1所示。图2.1 激光传感器扫描范围示意图2.2.2 摄像头本文中所用的仿真摄像头是按照日本SANYO公司生产的CCD设计的，它主要将机器人在室内巡视时所到的地方的图像显示在窗口中，便于我们观察，有利于我们对室内的一切状况进行实
16、时的监控。一旦遇到什么情况，我们可以第一时间知道并及时的做出相应的正确的反应。2.2.3 差分驱动轮本次研究中所使用的仿真机器人是采用轮式结构，由2个驱动轮和一个辅助轮组成。因此机器人所能完成的动作主要通过对仿真机器人左右轮的不同控制来实现的，现在我们分别设仿真机器人的左轮子的速度为，右轮子的速度为， 如图2.2所示。图2.2 机器人平面图接下来，我们对二轮差分轮式移动机器人进行相关的分析，现在分别设仿真机器人的左轮子的速度为，右轮子的速度为。 图2.3 机器人位置和姿势示意图则将仿真机器人的左右轮子的速度，转换成线速度v 及角速度分别为: （2-1）式中d 为仿真机器人右边轮子到左边轮子的距
17、离。根据图2.3知， 机器人的位置和姿势的表达形式为( x ，y ，) ，其中( x ，y) 为机器人重心到坐标轴边界的距离，为机器人与坐标轴X的夹角，则 （2-2）式（2-2）说明，我们可以讲对机器人线速度和角速度的控制转化对机器人左右轮子的速度的控制。现在我们重新来定义一个新的函数关系式d =f (x ，y) ，其中(x ，y)为仿真机器人此时此刻所处的地理位置，而f ( x ，y)= 0为我们期望机器人所做的运动轨迹，则 （2-3）式中，为我们刚刚设的控制变量。由式（2-3）得: 2.3 室内巡视机器人的开发环境2.3.1 仿真环境Microsoft Robotics Developer
18、 Studio 2008 R3本文所采用的仿真环境是Microsoft Robotics Developer Studio 2008 R3，微软机器人的通用开发平台Robotics Developer Studio 2008第三个版本R3版本，简称RDS 2008 R3。Robotics Developer Studio是微软在06年开始，面向机器人应用开发而推出的一个平台，是基于.NET Framework的开发环境，微软RDS支持多种机器人平台，既可以在运行着Windows系统的嵌入式PC上直接运行，也可以在Windows PC上通过蓝牙、Wi-Fi等无线连接远程控制。2.3.2 编程环境
19、visual studio 2008本文所采用的仿真环境是Microsoft Visual Studio，是面向Windows Vista、Office 2007、Web 2.0的开发工具。VS2008引入了250个新特性，整合了对象、关系型数据、XML访问方式，语言更加简洁。这个版本包含了众多版本，分别面向不同的开发角色。能创建满足关键性要求的多层次智能客户端、Web、或基于Microsoft Office等应用程序。使用Visual Studio 2008可以高效地开发Windows应用程序，可以实时反映变更，智能感知功能可以提高开发效率。同时Visual Studio 2008支持项目模
20、板、部署程序和调试器。2.4 仿真机器人的总体巡视方案2.4.1 总体巡视方案室内巡视机器人的总体巡视方案结构框图如2.4所示。总体方案主要包括：激光传感器、摄像头数据的接口，避障，路径规划，实时监控，手动控制。图2.4 总体巡视方案结构框图2.4.2 传感器数据接口激光传感器、摄像头数据的接口，它主要是将采集到激光传感器、摄像头的数据实时的传送到机器人。机器人，巡视的主体，它将接收到的数据进行处理，然后根据程序做出相应的正确的动作，使其能够顺利的进行巡视。2.4.3 避障避障，就是机器人在接收到激光传感器传来的关于前方障碍物的距离信息后，根据已经编写好的程序来控制机器人偏转的方向和角度达到避
21、开障碍物的目的。本文所采用的避障方法：获取激光数据后，我们可以根据获取的数据编写一个避障的控制程序，即当激光检测到的前方障碍物距离小于500，就转个方向。2.4.4 路径规划路径规划，路径规划是机器人在室内进行巡视的基本环节。它所要达到的目的是使机器人在存在障碍物的环境中，按照一定的标准，寻找到一条从起点到终点的最优或近似最优的无障碍路径。这里我们可以根据获得的传感器信息，即障碍物的尺寸、形状和位置等信息，然后对这些信息进行处理，并根据所要到达的效果来设计一条最合适的路径。本文所采用的路径规划方法是沿墙走，即机器人沿着室内的墙壁进行巡视。2.4.5 实时监控实时监控，它主要将机器人在室内巡视时
22、所到的地方的图像显示在窗口中，便于我们观察，有利于我们对室内的一切状况进行实时的监控。一旦遇到什么情况，我们可以第一时间知道并及时的做出相应的正确的反应。2.4.6 手动控制手动控制，虽然自动巡视具有很多的优点，如方便，快捷，自主等，但是也有些不足，比如操作不灵活，功能单一等。为此我们专门引入了手动控制器来增加操作的灵活性和多样化的功能。我们设计出一个可视化的操作界面来介入机器人的仿真过程，譬如启动/暂停仿真，自动/手动的切换，手工设置机器人的速度和前进、后退、左转、右转等。3 仿真机器人巡视算法及实现3.1 仿真环境建立及编程调试3.1.1 仿真环境建立首先启动Microsoft Visua
23、l Simulation Environment 2008仿真软件，选择软件自带的Apartment Environment场景，然后在场景中添加一个差分驱动轮机器人，并且机器人上添加摄像头、激光传感器。如下图： 图3.1 仿真环境3.1.2 控制程序的编写首先打开Visual C# 2008，新建一个项目，选择Microsoft Robotics的DSS Service模板，如下图，名称命名为zmh：图3.2 新建DSS模板点击“确定”后，出现如下选项：（如图3.3所示）图3.3 选项卡点击“Partners”选项卡，选择希望添加的合作关系，然后点击“Add as Partner”按钮。我们
24、在仿真环境中使用了差分驱动轮，激光，Web摄像头。因此，总共需要添加四个Partner：Simulation Engine, Simulated Generic Differential Driver, Simulated Laser Range Finder, Simulated Webcam。然后点击“OK”后即可根据选项自动创建项目文件。总的控制步骤可以概括如下：机器人从激光传感器获得数据进行运算输出控制命令。 3.2 避障3.2.1 获取激光数据对于一个控制程序，一般的步骤是：从机器人的传感器获取传感数据-运算-输出控制命令。为了获取激光数据，我们去要向激光传感器发送一个Get消息，等
25、待其返回后即可得到激光传感器数据了。因此定义一个更新激光数据的任务函数：IEnumerator UpdateLaser(DateTime dateTime) var sensorOrFault = _simulatedLRFServicePort.Get(); yield return sensorOrFault.Choice(); if (!HasError(sensorOrFault) sicklrf.State sensorState = (sicklrf.State)sensorOrFault; /激光数据放在sensorState的DistanceMeasurements属性中。 A
26、ctivate(Arbiter.ReceiveWithIterator(false, _dateTimePort, UpdateLaser); TaskQueue.EnqueueTimer(TimeSpan.FromMilliseconds(60), _dateTimePort); yield break; 图3.4 获取激光数据程序为了使UpdateLaser任务不断地重复执行，我们定义一个计数器消息端口，延时一定时间后就执行UpdateLaser任务。zmhService类中定义一个时间端口：Port _dateTimePort = new Port();图3.5 定义时间端口程序在类方法
27、Start中，启动计时器：Activate(Arbiter.ReceiveWithIterator(false, _dateTimePort, UpdateLaser);TaskQueue.EnqueueTimer(TimeSpan.FromMilliseconds(600), _dateTimePort);图3.6 启动计时器程序第一句告诉DSS，当_dateTimePort消息来时，执行UpdateLaser任务，第一个参数false表示只执行一次。由于_dateTimePort的消息类型是DateTime，所以我们需要重新定义UpdateLaser任务为：IEnumerator Upda
28、teLaser(DateTime dateTime)。第二句启动一个延时计数，当经过600毫秒后，就往_dateTimePort发送一个消息。这样当600毫秒之后，就会执行UpdateLaser任务。这样只能执行一次，为了使UpdateLaser任务不断重复执行，我们在UpdateLaser任务函数的结尾再加上上述两句，这样的话UpdateLaser就能不断地重复了。3.2.2 避障的实现避障就是机器人在接收到激光传感器传来的关于前方障碍物的距离信息后，根据已经编写好的程序来控制机器人偏转的方向和角度达到避开障碍物的目的。本文所采用的避障方法：获取激光数据后，我们可以根据获取的数据编写一个避障
29、的控制程序，即当激光检测到的前方障碍物距离小于500mm，就转个方向。又因为激光数据是180范围的，我们取中间的60作为障碍判断依据，如图3.7所示。为了更好的实现避障功能，使避障时机器人的转向与下面将要讲到的沿墙走路径规划有效的结合起来，以达到巡视时的最佳效果，现我们将这60的范围分成左右各30（即6090和90120）。当激光检测到6090范围内有障碍物且只小于500的安全距离时，机器人向左转，如图3.8（a）所示；当激光检测到90120范围内有障碍物且只小于500mm的安全距离时，机器人向右转，如图3.8（b）所示。这样就实现了机器人的避障功能。图3.7 激光探测示意图避障示意图如下所示
30、：图3.8（a） 机器人避障示意图图3.8（b） 机器人避障示意图3.2.3 避障程序根据机器人获取来的激光传感器数据，结合我们选择的避障方法，按照我们的要求编写的避障程序。（1）当激光检测到6090范围内有障碍物且只小于500mm的安全距离时，机器人向左转的避障程序如下图所示。int laserCount = sensorState.DistanceMeasurements.Length; for (int i = laserCount / 3; i laserCount / 2; i+) if (sensorState.DistanceMeasurementsi 500) _simulat
31、edDifferentialDriveServicePort.SetDriveSpeed(-0.1f, 0.1f); LogInfo(Obstacle Avoid!);Activate(Arbiter.ReceiveWithIterator(false, _dateTimePort, UpdateLaser); TaskQueue.EnqueueTimer(TimeSpan.FromMilliseconds(200), _dateTimePort); yield break; 图3.9 避障程序int laserCount = sensorState.DistanceMeasurements.
32、Length;图3.10这条语句是将存放在sensorState的DistanceMeasurements属性中的激光数据赋值给我们设的整型变量laserCount。int i = laserCount/3; i laserCount/2;i+图3.11这条语句是实现取激光数据6090的范围的数据。if (sensorState.DistanceMeasurementsi 500) _simulatedDifferentialDriveServicePort.SetDriveSpeed(-0.1f, 0.1f); LogInfo(Obstacle Avoid!);Activate(Arbite
33、r.ReceiveWithIterator(false, _dateTimePort, UpdateLaser); TaskQueue.EnqueueTimer(TimeSpan.FromMilliseconds(200), _dateTimePort); yield break; 图3.12这段程序是实现避障，当机器人与障碍物的距离小于500mm时，机器人的右轮子的速度就减小，而左轮子的速度不变，这样就实现了机器人向左转；当机器人与障碍物的距离大于500mm时，机器人左右轮的速度保持不变且一样，这样机器人就直线前进。Activate(Arbiter.ReceiveWithIterator(f
34、alse, _dateTimePort, UpdateLaser);TaskQueue.EnqueueTimer(TimeSpan.FromMilliseconds(200), _dateTimePort);图3.13这两条程序是用来刷新激光数据，这里我们设定的定时器定时时间是200ms，即0.2s。每隔0.2s就刷新一次激光数据，这样就可以达到实时采集激光数据的目的了，使机器人更好的完成避障任务。（2）当激光检测到90120范围内有障碍物且只小于500的安全距离时，机器人向右转的避障程序如下图所示。for (int i = laserCount / 2; i 2 * laserCount /
35、 3; i+)if (sensorState.DistanceMeasurementsi 500) _simulatedDifferentialDriveServicePort.SetDriveSpeed(0.1f, -0.1f);LogInfo(Obstacle Avoid!);Activate(Arbiter.ReceiveWithIterator(false, _dateTimePort, UpdateLaser); TaskQueue.EnqueueTimer(TimeSpan.FromMilliseconds(200), _dateTimePort); yield break; 图3
36、.14这种情况与（1）的情况相似，程序解释请参照上面解释，在此不再进行累述。在这里，我们用到了差分驱动轮的消息端口_simulatedDifferentialDriveServicePort，并根据激光数据向其发送驱动参数。3.3 路径规划路径规划是机器人在室内进行巡视的基本环节。它所要达到的目的是使机器人在存在障碍物的环境中，按照一定的标准，寻找到一条从起点到终点的最优或近似最优的无障碍路径。这里我们可以根据获得的传感器信息，即障碍物的尺寸、形状和位置等信息，然后对这些信息进行处理，并根据所要到达的效果来设计一条最合适的路径。3.3.1 机器人沿墙巡视的设计本文所采用的路径规划方法是沿墙走，
37、即机器人沿着室内的墙壁进行巡视。因为本文研究的重点不是路径规划，而是室内巡视机器人的设计，所以考虑的到执行的难以程度，所到达的效果（由于机器人要进行巡视，本身带有摄像头，那么沿墙走就可以到达看得到室内的一切这个效果）等，选择沿墙走这种方法就可以到达要求的效果，因此选择沿墙走的路径规划方法。示意图如图3.15。图3.15 沿墙走示意图3.3.2 最小二乘原理设有一独立等精度的测量列（i=1，2，3，n），其残差（或偏差）为= ，残差的平方和为： （3-1）式中，。 当其残差= 满足=min时，显然对于任何而， （3-2）当X= 时，取得最小值，以上就是最小二乘原理。3.3.3 直线拟合假定所求实
38、验数据的最佳拟合直线方程为： （3-3）式中，A为直线的截距；B为其斜率。根据最小二乘原理求得： （3-4）或 （3-5）3.3.4 机器人沿墙走巡视的设计机器人沿墙走的仿真图如图3.16所示。图3.16 沿墙走仿真示意图（1）沿墙走的激光束分布本文中所用的仿真激光传感器是按照德国SICK公司生产的LMS200设计的，它的扫描范围最大可以到达8m，扫描角度为180，而将这个180的半圆分成0360共361份，其角度分辨率为0.5一份，如图3.17所示。这360份用极坐标表示，见式（3-6）。 （3-6）式中，i表示激光束的第i束。图3.17 沿墙走激光束分布示意图（2）沿墙走的判断设激光打在墙
39、上的个数为n，机器人与墙的距离为d。（1）当激光打在墙上的个数小于3时（n3），与墙的距离小于8000mm（d8000mm）时，机器人就继续向前进；如图3.18所示。（2）当激光打在墙上的个数大于3时（n3），与墙的距离小于8000mm（d8000mm）时，此时就要进行拟合；图 3.183.3.5 机器人沿墙走巡视的实现设定机器人的右侧始终靠近墙，当机器人靠近墙时，为了分析方便，现我们取激光打在墙上的A1A10十个点，如图3.19所示，而我们需要的是落在045范围内的点，再经过筛选，我们选择距离为50mm1200mm之间的点进行拟合。之所以选择这个范围，是因为如果我们将大于1200mm的点也包
40、括进来会影响直线拟合的效果，因此我们经过反复的调试最终确定上述这样一个距离区间。然后通过极坐标的转换将筛选出来的点转换成对应平面坐标，极坐标转换公式见式（3-7）。最后对转换后的坐标运用最小二乘直线拟合，经过计算得出拟合后的直线Y=C+DX，其中C,D由最小二乘直线拟合法求出，见公式（3-4），(3-5)。再设，分别为机器人左、右轮速，根据机器人右侧与墙的距离d（如图所示）来计算实时的，。 （3-7）式中，是第i束激光到墙壁的距离，是是第i束激光的角度。然后根据最小二乘原理和直线拟合的公式（3-4）计算出斜率B，截距A，而C=A,D=B。再根据斜率D按照公式（3-8）计算出角度。 （3-8）因
41、为拟合出来的直线斜率有正负之分，所以计算出来的角度，如果按数学上定义，则有大于90和小于90的区别。而我们这里计算出来的角度的范围是-9090，即当D0时，0；当D0时，0。由于程序中的坐标轴与数学定义上的坐标轴不一样，因此我们要对使用的角度进行转换，见公式（3-9）。 （3-9）仿真机器人左右轮子的速度计算见公式（3-10） （3-10）其中是当前机器人行进的速度，为调试系数，且，经过反复的调试，最后我们确定比较理想系数=0.1。图3.19 沿墙走拟合示意图3.3.6 机器人沿墙走巡视的特殊情况机器人在内室进行巡视时，经常会出现机器人走到直角地带，如图3.20所示。此时，机器人处于特殊情况下
42、，因此沿墙走也要单独进行分析，解决。当机器人靠近墙时，我们需要的是落在045范围内的点，再经过筛选，我们选择距离为50mm1200mm之间的点进行拟合，见式（3-6）。然后对转换后的点运用最小二乘直线拟合，经过计算得出拟合后的直线Y=C+DX，其中C,D由最小二乘直线拟合法求出（假设红线为拟合后的路线），见公式（3-4），(3-5)。再设，分别为机器人左、右轮速，根据机器人右侧与墙的距离d（如图所示）来计算实时的，。图3.20 沿墙走特殊情况拟合示意图3.4 实时监控3.4.1 获取摄像头数据摄像头数据的获取过程与激光数据的获取过程类似定义一个获取摄像头数据的任务函数UpdateImage。程序代码如下：IEnumerator UpdateImage(DateTime dateTime) byte rgbData = null; Size size = new Size(0, 0); yield return Arbiter.Choice(_simulatedWebcamServicePort.QueryFrame(), succ
