机器人3D仿真系统使用教程

1、. -. -可修编- . z. -. -可修编- .机器人3D仿真系统教材-. z.*市太平村第二中学汝生 整理目 录TOC o 1-3 h z uHYPERLINK l _Toc270925884前言 PAGEREF _Toc270925884 h 2HYPERLINK l _Toc270925885第一局部预备知识 PAGEREF _Toc270925885 h 3HYPERLINK l _Toc2709258861.1 虚拟机器人的构造与功能 PAGEREF _Toc270925886 h 3HYPERLINK l _Toc2709258871.1.1 身体构造 PAGEREF _Toc

2、270925887 h 3HYPERLINK l _Toc2709258881.1.2 感觉器官 PAGEREF _Toc270925888 h 3HYPERLINK l _Toc2709258891.1.3 编程语言 PAGEREF _Toc270925889 h 5HYPERLINK l _Toc2709258901.2 机器人3D仿真系统能做什么 PAGEREF _Toc270925890 h 5HYPERLINK l _Toc2709258911.2.1 为机器人编写程序 PAGEREF _Toc270925891 h 5HYPERLINK l _Toc2709258921.2.2 创

3、立环境 PAGEREF _Toc270925892 h 5HYPERLINK l _Toc2709258931.2.3 仿真运行 PAGEREF _Toc270925893 h 6HYPERLINK l _Toc270925894第二局部初试身手 PAGEREF _Toc270925894 h 7HYPERLINK l _Toc270925895第一课简易机器人安装 PAGEREF _Toc270925895 h 8HYPERLINK l _Toc270925896第二课机器人前进 PAGEREF _Toc270925896 h 12HYPERLINK l _Toc270925897第三课机器

4、人转弯 PAGEREF _Toc270925897 h 19HYPERLINK l _Toc270925898第四课机器人走正方形 PAGEREF _Toc270925898 h 22HYPERLINK l _Toc270925899第五课机器人走五角星 PAGEREF _Toc270925899 h 27HYPERLINK l _Toc270925900第六课机器人走圆形 PAGEREF _Toc270925900 h 32HYPERLINK l _Toc270925901第七课落地扇 PAGEREF _Toc270925901 h 35HYPERLINK l _Toc270925902第八

5、课机器人测障 PAGEREF _Toc270925902 h 41HYPERLINK l _Toc270925903第九课机器人走轨迹 PAGEREF _Toc270925903 h 49HYPERLINK l _Toc270925904第十课机器人走迷宫 PAGEREF _Toc270925904 h 61HYPERLINK l _Toc270925905第三章稳步前进 PAGEREF _Toc270925905 h 64HYPERLINK l _Toc270925906第十一课走正方形 PAGEREF _Toc270925906 h 65HYPERLINK l _Toc270925907第

6、十二课赛车 PAGEREF _Toc270925907 h 69HYPERLINK l _Toc270925908第十三课曲棍球比赛 PAGEREF _Toc270925908 h 74HYPERLINK l _Toc270925909第十四课避障 PAGEREF _Toc270925909 h 79HYPERLINK l _Toc270925910第十五课街道灭火 PAGEREF _Toc270925910 h 82HYPERLINK l _Toc270925911第十六课消防员灭火 PAGEREF _Toc270925911 h 86HYPERLINK l _Toc270925912第十七

7、课消防员搜索 PAGEREF _Toc270925912 h 90HYPERLINK l _Toc270925913第十八课机器人探宝 PAGEREF _Toc270925913 h 94HYPERLINK l _Toc270925914第十九课射门 PAGEREF _Toc270925914 h 97HYPERLINK l _Toc270925915第二十课点球 PAGEREF _Toc270925915 h 101HYPERLINK l _Toc270925916第二十一课测障 PAGEREF _Toc270925916 h 105HYPERLINK l _Toc270925917第二十二

8、课过人 PAGEREF _Toc270925917 h 108HYPERLINK l _Toc270925918第四局部我能赢 PAGEREF _Toc270925918 h 111HYPERLINK l _Toc2709259194.1 灭火比赛 PAGEREF _Toc270925919 h 111HYPERLINK l _Toc2709259204.2机器人轨迹比赛 PAGEREF _Toc270925920 h 111HYPERLINK l _Toc270925921附录一：机器人3D仿真系统的安装 PAGEREF _Toc270925921 h 111HYPERLINK l _Toc

9、270925922附录二：功能及函数说明 PAGEREF _Toc270925922 h 111HYPERLINK l _Toc270925923附录三：如何利用工具制作地面纹理 PAGEREF _Toc270925923 h 111HYPERLINK l _Toc270925924附件四：仿真机器人的端口说明 PAGEREF _Toc270925924 h 111第一局部预备知识在本章中，我们对机器人3D仿真系统作一个简单介绍，让读者初步了解机器人的构造、传感器和编程语言。在读完本章容之后，相信读者就能方便地使用机器人3D仿真系统了。1.1 虚拟机器人的构造与功能身体构造感觉器官智能机器人的

10、感觉功能，是由机器人身上的传感器实现的。纳英特机器人身上安装的传感器有以下几种：1. 红外传感器红外传感器由红外发射器和红外接收器两局部组成。当接收装置收到发射装置发射的红外信号，机器人即可利用收到的信号来识别周围特定环境的变化。机器人就是利用这一原理对检测其周围有、无障碍物的。红外传感器测到障碍物返回给主机的数值为1，没测到障碍物返回为0。红外传感器构造如图1-1所示。图1-1 红外传感器构造图2. 火焰传感器火焰传感器能够检测光线的强度，检测到的值为0255 之间的整数。光线越亮，检测到的数值越小；光线越暗，检测到的数值越大。此项功能跟实物的纳英特8位机器人根本一样。火焰传感器构造如图1-

11、2所示。图1-2 火焰传感器构造图3. 碰撞传感器碰撞传感器 碰撞传感器是由一个接触导轮和一个接触开关组成。当接触导轮碰到物体时，接触开关会被按下。当开关按下时返回主机的数值为0，没按下时返回主机的数值为1，碰撞传感器构造如图1-3所示。图1-3碰撞传感器图示碰撞方向确实定 利用碰撞传感器，可以判断碰撞发生的方向，在机器人适宜位置安装碰撞传感器，当*一处的碰撞传感器发生了碰撞，传感器返回的值为0，否则为1，利用这个值，可以确定发生碰撞的方向。4. 地面灰度传感器地面灰度传感器由一个发射装置和一个接收装置组成。发射装置发出的光照射到地面，接收装置通过检测返回的光线强度并将其转换为机器人可以识别的

12、信号。不同颜色反射光的强度不同，颜色越深，反射光越弱，返回的数值就越大；反之，返回的数值就越小，检测到的值为0255 之间的整数。此项功能跟实物的纳英特8位机器人根本一样。地面灰度传感器构造如图1-4所示。图1-4 地面灰度传感器图示5. 指南针传感器指南针传感器是利用地球磁场区分方向，并将其转换成机器人可以识别的模拟信号。指南针传感器的返回值为0360之间的整数。可根据实际需要，将任意方位的传感器值调整设置为特定的值。指南针传感器构造如图1-5所示。图1-5 指南针传感器图示编程语言纳英特智能机器人的编程语言是 C语言，由机器人C语言和流程图编程语言两局部组成。读者使用仿真版的时候，可以用流

13、程图编程。在用流程图编程的同时，可以自动生成C代码，便于读者观察、解释或修改程序，参见图16。在图16中，左边模块库，中间是流程图，右边是C代码。在流程图编辑界面右侧，即可看到当前程序的C代码。图1-61.2 机器人3D仿真系统能做什么为机器人编写程序在纳英特机器人仿真版中，可以用流程图编写机器人程序，同时自动生成C 代码。也可以直接在翻开程序编辑器的时候选择用C语言为机器人编写程序为。创立环境可以自由创立环境是机器人3D仿真的一个突出优点，这往往是使用真实的机器人时所做不到的。在纳英特3D仿真软件中，读者可以利用光源、障碍物构建各种环境，也可以利用画图工具画各种轨迹图然后导入到仿真中。如房间

14、、迷宫、轨迹灭火场地等。下面的图17就是用仿真版创立的一个场地机器人轨迹灭火。图1-7仿真运行仿真运行就是进入仿真环境，让虚拟机器人按照控制程序指令运行。编好程序、创立环境、搭建好机器人之后，就可以仿真运行了。因此，在仿真版中，读者能够直观地看到机器人运行的效果。第二局部 初试身手本章容是以机器人工程的形式编写的，既便于初学者入门，也便于已有根底的读者参考。通过本章的学习，读者学会简单程序的编写及机器人工程制作的根本步骤。机器人，顾名思义，就是类似人的机器。本章主要介绍了机器人的执行器，即机器人的液晶显示屏、运动系统、传感器，相当于人的口、腿脚、眼睛。读者只要边看边做，很快就能熟悉机器人了。第

15、一课简易机器人安装1翻开仿真软件，在主界面上点击机器人搭建按钮。即可进入机器人编辑场景。如图2-1所示：图2-12) 在初始机器人选项中选择新建，机器人组件选项中选择马达，单击添加部件，然后用鼠标左键选择要添加部件的位置，如图2-2所示。图2-23) 选中马达的装配点，再以装配点为旋转中心进展角度的调整，再点击要装配的主机位置，如图2-3所示。图2-34) 安装好后，单击右键选择马达，单击左键设置属性，将左电机端口号设置为0，同样操作设置右电机端口号设置为1，电机端口号可以设置为0、1、2、3马达装配后如图2-4所示。图2-45)在机器人组件里选择轮子，在部件类型列表里选择小轮宽胎进展装配，为

16、马达装配轮胎，装配方法和装马达的方法一样。装好后如图2-5所示。图2-56) 最后再为机器人安装万向轮。在机器人组件里选择轮子，在部件类型列表里选择万向轮进展装配。装配好如图2-6所示。图2-6单击完成，保存机器人。这样就完成一个简单的机器人马达、轮子的装配。第二课机器人前进学习任务本节课将学习控制机器人前进和驱动左右电机的方法，学习使用执行器模块库中的移动模块和启动电机模块编写程序，熟悉制作仿真工程的根本不步骤和方法。本节课需用的机器人同第一课搭建的机器人场地搭建软件点击场地编辑即可进入场景编辑局部：场景组件选择：标识点起始点，如图2-6所示。位移方向盘长度、宽度调节栏图2-6添加到场景中如

17、上图所示，在起始点上点击鼠标右键选择设置属性，通过左侧上方的长度和宽度条对起始点的大小进展调节，同时可通过下方位移方向盘，对起始点位置进展调节。场地编辑完成后点击右下角完成按钮保存文件。文件命名为机器人前进-场地。程序设计1点击主界面上的进入仿真，在程序代码下拉菜单中选择新建开场程序的编写给机器人赋予智慧。如图2-7所示。图2-7一般选用流程图文件。如果能熟练运用C语言的也可以选择C语言文件。2进入机器人编程环境，拖动执行器模块库中的移动模块到主程序下，如图2-8所示。单击鼠标左键拖到主程序下图2-8在拖动时，必须将拖动的模块对准主程序下方的黑色箭头，当箭头变为红色时，松开鼠标左键，这样才能成

18、功地将此模块与主程序连接起来。如果模块图标的外框是虚线框，则表示模块之间没有正确连接，此时，可以用鼠标左键拖动模块重新连接也可以单击鼠标左键选中错误连接的模块，按Delete键，确认后删除。双击移动图标，进展参数设置。左右电机分别输入一样的数值70，此时电机正转，如图2-9所示。2输入701输入703单击图2-93在模块库中选择 延时模块，并拖动到前进模块下面，正确连接后双击延时模块设置机器人时间为1.5秒钟，如图2-10 所示。1拖动延时2双击4输入时间值5单击确定3选中时间准确度图2-104在程序设计中，当机器人到达目的地后停下来，需要从执行器模块库中拖动停顿模块到延时模块下,并设置参数让

19、机器人停顿。取消选择停顿所有电机，选择电机0、电机1，设置完成后，程序流程图中的停顿模块，显示为停顿电机0,1。如果机器人安装有多个电机，则根据机器人装配的实际情况选择停顿相应的电机，如图2-11所示。1拖动停顿模块到延时模块下2双击3单击确定图2-11最后关闭窗口并保存文件到默认的目录下，命名为机器人前进-程序。如图2-12所示。图2-12仿真运行点击进入仿真进入机器人组队的设置界面，规则选择常规，场地选择保存的场地：机器人前进-场地；分组不用设置；机器人名称可以随便命名；程序代码选择保存的程序：机器人前进-程序；机器人选择第一课搭建的机器人。此时点击下一步进入仿真。具体设置如图2-13所示

20、。图2-13在下面这个界面上点击进入仿真会自动跳出保存工程对话框。输入工程名称即可以对做好的仿真工程进展保存以便在快速启动中翻开。如图2-14所示。图2-14保存好之后，将进入如图的界面点击开场，开场运行做好的仿真。如图2-15所示。图2-15当发现机器人的硬件或者程序有问题需要修正的时候按以下操作进展：机器人程序的修改当鼠标右键选中主机盒，屏幕左上角会弹出一个运行参数的对话框，对话框下方有个代码显示，点击代码显示。下方就会出现对应的C代码。翻开后如图2-16所示。图2-16在机器人显示出代码框任意位置双击鼠标左键，即进入代码编辑界面可对机器人程序进展修改保存，然后复位，再重新开场运行机器人。

21、同时在此状态下，可看到机器人当前正在运行的*段代码，便于发现错误并进展及时修改。：场地的修改在场地任意位置点击鼠标右键选择编辑，即可对场地进展修改。如图2-17所示。图2-17各显神通分别用移动和启动电机模块编写程序完成机器人前进2秒再后退2秒停顿的任务，并在仿真中实现。第三课 机器人转弯学习任务本节课将学习移动模块或启动电机模块实现机器人转弯，通过设置左右轮转速的不同实现机器人准确转弯。这节课需用的场地同第二课搭建的场地、机器人同第一课搭建的机器人策略分析如果要实现机器人转向，可以通过机器人左、右轮差速来实现，当左电机转速快于右电机转速时，机器人右转；当左电机转速慢于右电机转速时，机器人左转

22、。当左、右电机转速相等并为正值时设置左右电机功率分别是70、70，机器人前进。当左、右电机转速相等并为负值时设置左右电机功率分别是-70、-70，机器人后退。左右电机转速相差越大，机器人转弯半径越小，反之则越大。一个为正值，一个为负值则为原地转如右电机功率分别是70、-70。程序设计1翻开程序编辑器，拖动模块库下的移动模块到主程序的下方，并双击移动模块设置左右电机的功率分别为90,70右转。如图2-18所示。图2-182在模块库中选择 延时模块，并拖动到前进模块下面，正确连接后双击延时模块设置机器人时间为1.0秒钟，如图2-19 所示。图2-193最后，添加停顿模块并设置停顿0,1电机。编辑好

23、的程序如图2-20所示。图2-20程序编辑完成后点击关闭并保存文件，文件命名为机器人转弯-程序。仿真运行点击进入仿真进入机器人组队的设置界面，规则选择常规，场地选择2.2课的场地：机器人前进-场地；分组不用设置；机器人名称可以随便命名；程序代码选择保存的程序：机器人转弯-程序；机器人选择2.2节所搭建的机器人。具体设置如图2-21所示。图2-21此时点击下一步进入仿真。在机器人与场地合成界面上点击进入仿真会自动跳出保存工程对话框。输入工程名称即可以对做好的仿真工程进展保存以便在快速启动中翻开。保存好之后，将进入如图2-22所示的界面点击开场，开场运行做好的仿真。图2-22各显神通编写程序完成机

24、器人前进两秒后左转90停顿的任务，并在仿真中实现。第四课 机器人走正方形学习任务本节课将学习 屡次循环、移动、延时模块的综合使用，实现机器人走出正方形。这节课需用的场地同第二课搭建的场地、机器人同第一课搭建的机器人策略分析本工程的难点在于要反复调整移动和延时模块的参数速度和时间实现转弯90，以便机器人正好转90。要实现机器人走出一个正方形，就要机器人前进一段距离，然后转弯90，这个动作循环执行4次，就可以走出一个正方形了。所以这个工程我们要使用屡次循环模块来实现前进转弯的动作执行4次。另外要注意的是，使用屡次循环模块的时候，须将待循环的容放在循环体部。程序设计 1在控制模块库中选择屡次循环模块

25、拖动到主程序的下方，并双击翻开参数设置对话框，即可输入循环次数。这里走正方形我们需要前进，转弯的动作执行4次，这里我们就设置循环4次。具体设置见图2-23。图2-232拖动执行模块库中的移动模块到屡次循环模块的中间，双击设置左右马达的功率为100，100。如图2-24所示。图2-24 3拖动延时模块到前进模块的下方，双击翻开参数设置对话框，设置时间为1.5秒。如图2-25所示。图2-254拖动模块库下的移动模块到延时模块的下方，并双击移动模块设置左右电机的功率分别为66,-66原地右转。如图2-26所示。图2-265拖动延时模块到右转模块的下方，双击翻开参数设置对话框，设置时间为0.1秒。如图

26、2-27所示。图2-276最后拖动停顿模块到屡次循环模块的外面，设置为停顿0、1号电机。如图2-28所示。图2-28仿真运行点击进入仿真进入机器人组队的设置界面，规则选择常规，场地选择2.2课的场地：机器人前进-场地；分组不用设置；机器人名称可以随便命名；程序代码选择保存的程序：走正方形-程序；机器人选择2.2节所搭建的机器人。具体设置如图2-29所示。图2-29此时点击下一步进入仿真。在机器人与场地合成界面上点击进入仿真会自动跳出保存工程对话框。输入工程名称即可以对做好的仿真工程进展保存以便在快速启动中翻开。保存好之后，将进入如图2-30所示的界面点击开场，开场运行做好的仿真。图2-30各显

27、神通 动手编程完成机器人走正三角形的任务，并在仿真中实现。第五课 机器人走五角星学习任务本节课将学习 屡次循环、移动、延时模块的综合使用，实现机器人走出五角星的形状。这节课需用的场地同第二课搭建的场地、机器人同第一课搭建的机器人策略分析本工程的难点在于要反复调整移动和延时模块的参数速度和时间实现转弯144，以便机器人正好转144。要实现机器人走出一个五角星，就要机器人前进一段距离，然后转弯144，这个动作循环执行5次，就可以走出一个五角星了。程序设计 1在控制模块库中选择屡次循环模块拖动到主程序的下方，并双击翻开参数设置对话框，即可输入循环次数。这里走五角星我们需要前进，转弯的动作执行5次，这

28、里我们就设置循环5次。具体设置见图2-31。图2-312拖动执行模块库中的移动模块到屡次循环模块的中间，双击设置左右马达的功率为100，100。如图2-32所示。图2-32 3拖动延时模块到前进模块的下方，双击翻开参数设置对话框，设置时间为1.0秒。如图2-33所示。图2-334拖动模块库下的移动模块到延时模块的下方，并双击移动模块设置左右电机的功率分别为67,-67原地右转。如图2-34所示。图2-345拖动延时模块到右转模块的下方，双击翻开参数设置对话框，设置时间为0.2秒。如图2-35所示。图2-356最后拖动停顿模块到屡次循环模块的外面，设置为停顿0、1号电机。如图2-36所示。图2-

29、36仿真运行点击进入仿真进入机器人组队的设置界面，规则选择常规，场地选择2.2课的场地：机器人前进-场地；分组不用设置；机器人名称可以随便命名；程序代码选择保存的程序：走五角星-程序；机器人选择2.2节所搭建的机器人。具体设置如图2-37所示。图2-37此时点击下一步进入仿真。在机器人与场地合成界面上点击进入仿真会自动跳出保存工程对话框。输入工程名称即可以对做好的仿真工程进展保存以便在快速启动中翻开。保存好之后，将进入如图2-38所示的界面点击开场，开场运行做好的仿真。图2-38各显神通编写程序完成机器人走正六边形的任务，并在仿真中实现。第六课 机器人走圆形学习任务前面的课程中我们已经学习过如

30、何实现机器人原地转弯，本节课将继续学习 使用移动模块或启动电机模块实现机器人划弧转弯，通过设置不同的参数设置实现机器人走圆形。这节课需用的场地同第二课搭建的场地、机器人同第一课搭建的机器人策略分析如果要实现机器人走圆形，可以通过调整机器人左、右轮差速来实现，当左右电机转速均为正值并左电机转速快于右电机转速时例如左电机90，右电机70，机器人向右划弧；反之机器人向左划弧。左右电机转速相差越大，机器人转弯半径越小，反之则越大。程序设计 1翻开程序编辑器，拖动模块库下的移动模块到主程序的下方，并双击移动模块设置左右电机的功率分别为80,64右转。如图2-39所示。图2-392在模块库中选择 延时模块

31、，并拖动到前进模块下面，正确连接后双击延时模块设置机器人时间为5.0秒钟，如图2-40所示。图2-403最后，添加停顿模块并设置停顿0,1电机。编辑好的程序如图2-41所示。图2-41程序编辑完成后点击关闭并保存文件，文件命名为机器人走圆形-程序。仿真运行点击进入仿真进入机器人组队的设置界面，规则选择常规，场地选择2.2课的场地：机器人前进-场地；分组不用设置；机器人名称可以随便命名；程序代码选择保存的程序：走圆形-程序；机器人选择2.2节所搭建的机器人。具体设置如图2-42所示。图2-42此时点击下一步进入仿真。在机器人与场地合成界面上点击进入仿真会自动跳出保存工程对话框。输入工程名称即可以

32、对做好的仿真工程进展保存以便在快速启动中翻开。保存好之后，将进入如图2-43所示的界面点击开场，开场运行做好的仿真。图2-43各显神通编程在仿真中实现机器人从起点出发先向左走一个圆，回到起点位置后再向右走一个圆，最终停在起点的位置。第七课 落地扇学习任务本课将学习利用启动电机模块控制风扇电机，模拟落地扇可以左右摆动着吹。这节课需用的场地同第二课编辑的场地机器人的搭建在第一课搭建的机器人的根底上再增加一个风扇。翻开仿真软件，点击机器人搭建进入机器人编辑环境。1初始机器人选择第一课搭建好的机器人，由于要安装风扇，所以要用到铜柱来架高风扇。在组件选择里选择其他配件，部件里选择铜柱，点击添加部件，将铜

33、柱添加到编辑场景中。如图2-44所示。图2-442选中铜柱上的装配点，再以装配点为旋转中心进展角度的调整，再点击要装配的主机位置，如图2-45所示。图2-45如上方法，安装3根铜柱，安装好后如图2-46所示。图2-463组件选择马达，部件选择直流电机，点击添加部件将直流电机添加到编辑场景中。然后选中直流电机上的装配点，再以装配点为旋转中心进展角度的调整，再点击铜柱上的装配点，将直流电机装配到铜柱上。如图2-47所示。图2-47安装好直流电机后，鼠标右键点击直流电机，选择设置属性，翻开设置属性对话框，设置直流电机端口号为2。设置完成后点击确定保存。如图2-48所示。图2-484最后在组件中选择其

34、他配件，部件中选择风扇，点击添加部件将风扇添加到编辑场景中。然后选中风扇上的装配点，再以装配点为旋转中心进展角度的调整，再点击直流电机上的装配点，将风扇装配到直流电机上。如图2-49所示。图2-49安装完毕后点击右下角保存按钮保存机器人，命名为落地扇 机器人。程序设计1翻开程序编辑器，拖动控制模块库中的条件循环模块到主程序的下方，并双击翻开参数设置对话框，设置为永远循环。如图2-50所示。图2-502然后拖动执行器模块库中的启动电机模块到永远循环模块中。设置启动0、1、2号电机，设置0、1、2号电机的功率为10、-10、100。如图2-51所示。图2-51仿真运行点击进入仿真进入机器人组队的设

35、置界面，规则选择常规，场地选择2.2课的场地：机器人前进-场地；分组不用设置；机器人名称可以随便命名；程序代码选择保存的程序：落地扇-程序；机器人选择落地扇-机器人。具体设置如图2-52所示。图2-52此时点击下一步进入仿真。在机器人与场地合成界面上点击进入仿真会自动跳出保存工程对话框。输入工程名称即可以对做好的仿真工程进展保存以便在快速启动中翻开。保存好之后，将进入如图2-53所示的界面点击开场，开场运行做好的仿真。图2-53各显神通第八课 机器人测障学习任务本节课要学习红外避障传感器，了解红外避障传感器在实际中的*些应用；在机器人遇障停顿的活动中，学习永远循环、条件判断模块的使用以及其在编

36、程环境中的应用将学习。机器人的搭建1翻开第一课安装的机器人，在此根底上再安装红外避障传感器。组件选择传感器，部件选择红外避障传感器。选择好后点击添加部件将红外传感器添加到场景中。如图2-54所示。图2-542选中红外避障传感器的装配点，再以装配点为旋转中心进展角度的调整，再点击要装配的主机位置，如图2-55所示。图2-553安装好后，右键选择红外避障传感器，左键单击设置属性，将红外避障传感器的感应区夹角设置为19，半径设置为15，端口号设置为7，角度旋转为大约如下图的角度。设置完成后点击确定装配好如图2-56所示。角度调节按钮感应区调节栏图2-564按上面的方法再安装一个红外避障传感器到主机上

37、并设置端口号为8号口，感应区和角度大约如下图。设置完成后点击确定装配好如图2-57所示。图2-57 5同样的方法再在主机的正前方安装一个红外避障传感器，端口号设置为9、感应区域及角度设置大约为如下图。设置好后点击确定保存。如图2-58所示。图2-58最后，保存机器人，命名为测障走迷宫机器人。如图2-59所示。图2-59场地的搭建在2.2节搭建的场地根底上再添加一个挡板就可以制作本钱节课需要的场地了。1翻开2.2节编辑的场地，在场景组件里选择常用，现有部件类型里选择方体，点击添加部件添加到编辑场景中。如图2-60所示。图2-602属性设置。鼠标右键点击方体，选择设置属性翻开参数设置对话框。设置方

38、体的长、宽、高及位置。设置完成后点击确定。图2-61完成后点击右下角保存按钮保存场地，命名为遇障停顿-场地。程序设计1拖动控制模块库中的条件循环模块到主程序的下方，并双击条件循环模块设置为永远循环。如图2-62所示。图2-622然后拖动控制模块库中的条件判断模块到永远循环模块的中间，双击条件判断模块翻开参数设置对话框。条件设置为数字9号口是0。具体设置如图2-63。设置好后点击增加条件，最后点击确定按钮。图2-633拖动执行器模块库中的移动模块到条件判断模块的YES分支下，设置左右马达参数为100，100。如图2-64所示。图2-64 4最后拖动停顿模块到条件判断模块的NO分支下。设置为停顿所

39、有电机。如图2-65所示。图2-65编辑完成后，点击关闭按钮保存文件，命名为遇障停顿-程序。仿真运行点击进入仿真进入机器人组队的设置界面，规则选择常规，场地选择遇障停顿-场地；分组不用设置；机器人名称可以随便命名；程序代码选择遇障停顿-程序；机器人选择测障走迷宫机器人。具体设置如图2-66所示。图2-66此时点击下一步进入仿真。在机器人与场地合成界面上点击进入仿真，保存工程文件。保存好之后，将进入如图2-67所示的界面点击开场，开场运行做好的仿真。图2-67第九课 机器人走轨迹学习任务本节课将学习机器人走轨迹线的方法，通过本节课的学习，要学会机器人走轨迹的方法，同时熟悉较复杂程序的编写。策略分

40、析机器人利用地面灰度循迹最常见的三种方法是：只有一个地面灰度传感器时采用沿线法，机器人行走路线是一个个连续的圆弧；有两个地面灰度传感器时采用骑线法实现，安装两个地面灰度传感器之间的距离应比轨迹线的宽度大，机器人行走的路线似蛇形；用三个地面灰度传感器可采用压线法，在骑线法的根底上，在机器人的底部中间位置安装一个灰度传感器，机器人行走的时候，中间的灰度传感器一直压线行驶，如下列图所示。黑色线：为地面标示线绿色线：机器人行走轨迹红色色块：灰度传感器位置沿线法 骑线法 压线法 机器人循迹行走的三种方法沿线法走轨迹机器人行走分析：当机器人的灰度传感器检测到黑线时，说明机器人的行驶已经靠左了，则机器人向右

41、划弧；如果机器人的灰度传感器检测白线时，说明机器人的行驶已偏右，则让机器人向左划弧。检测地面灰度并把黑色的预设值大于180，白色值为80左右，在程序设计时，取80-180的中间值130作为判断黑白色的条件，即灰度传感器测得的值小于130，则是白色；测得的值大于130，则为黑色。骑线法走轨迹机器人行走分析：当机器人左边的灰度传感器检测到黑线时，说明机器人的行驶已经向右偏了，则机器人左转；当机器人右边的灰度传感器检测到黑线时，说明机器人的行驶已经向左偏了，则机器人右转；如果两个灰度传感器都没测到黑线，说明黑线在正中间，则机器人前进。压线法走轨迹机器人行走分析：当机器人中间的灰度传感器测到黑线同时两

42、边的灰度传感器测到的是白色时，机器人前进；接着进一步判断左边的灰度有没有测到黑线，当左边的灰度传感器测到黑线时，机器人左转；当机器人右边的灰度传感器测到黑线时机器人右转。机器人的搭建1翻开第一课安装的机器人，在此根底上再安装灰度传感器。组件选择传感器，部件选择灰度传感器。选择好后点击添加部件将灰度传感器添加到场景中。如图2-68所示。图2-682选中灰度传感器的装配点，再以装配点为旋转中心进展角度的调整，再点击要装配的主机位置，如图2-69所示。图2-693安装好后，右键选择灰度传感器，左键单击设置属性，将灰度传感器的感应区夹角设置为20，半径设置为3，端口号设置为2，角度旋转为大约如下图的角

43、度。设置完成后点击确定装配好如图2-70所示。角度调节按钮感应区调节栏图2-704按上面的方法再安装一个灰度传感器到主机上并设置端口号为3号口，感应区和角度大约如下图。设置完成后点击确定装配好如图2-71所示。图2-71最后，点击完成按钮保存机器人，命名为走轨迹机器人。如图2-72所示。图2-72场地的搭建本课的场地涉及到地面黑线纹理，而软件本身没有画黑线的工具，所以我们就需要在软件之外画黑色轨迹线，我们先在widows 自带的画图工具面要把场地的黑线画好。1翻开画图软件，点击图像属性，将宽度和高度都设置为300像素。如图2-73所示。图2-732在画图区画好所需要的黑线，注意线条粗细选择第二

44、种比拟合理。如图2-74所示。图2-74图画好之后，保存图片文件，注意文件类型为JPEG格式。如图2-75所示。图2-753将画好的图复制到仿真安装文件里面map 文件夹里面。如图2-76所示。图2-764翻开仿真，进入场地编辑，在场地上任意位置点击右键选择属性，在左边中间有个地图选项，在下拉菜单里选择刚复制到map文件夹里面的图片。如图2-77所示。图2-775然后添加起点到场地中，添加完成如图2-78所示。图2-78最后点击完成保存地图，命名为走轨迹-场地。程序设计沿线法程序设计：1拖动条件循环到主程序的下方并设置为永远循环。如图2-79所示。图2-792拖动条件判断模块到永远循环模块的中

45、间，条件设置为模拟3号口的值大于127。如图2-80所示。图2-803分别拖动一个移动模块到条件判断模块的YES和NO分支下，YES分支下的参数设置为80、50右转 ，NO分支下的参数设置为60、80左转。如图2-81所示。图2-81骑线法程序设计：1拖动条件循环模块到主程序的下方并设置为永远循环。如图2-82所示。图2-822拖动条件判断模块到永远循环的中间，设置条件判断模块的条件为模拟2号口的值大于127。接着在条件判断的YES分支下放一个移动模块并设置参数为30、60左转。如图2-83所示。图2-833再拖动一个条件判断模块放在第一个条件判断的NO分支下，并设置条件为模拟2号口的值大于1

46、27。如图2-84所示。图2-844在第二个条件判断模块的YES和NO分支下分别放一个移动模块，YES分支下的移动模块设置为右转，NO分支下的移动模块设置为100，100前进。如图2-85所示。图2-85由于仿真软件不方便在机器人的正中间安装灰度传感器，所以压线法走轨迹在这里就不做详细介绍了。仿真运行选择相关参数。点击开场运行做好的仿真。如图2-86所示。图2-86第十课 机器人走迷宫学习任务之前学习了红外避障传感器的使用，了解了红外避障传感器在实际中的简单应用，本节课我们继续使用避障传感器，通过这次活动，理解机器人走迷宫的策略，学习较复杂程序的编写。本节课使用第八课搭建的机器人策略分析如果一

47、个人在漆黑的迷宫场地中寻找出口，怎么才能走出迷宫呢？一般地，人会通过手的触摸来寻找行走路线，沿迷宫的围墙的*一侧行走可以使机器人走遍迷宫的每个地方，这是走迷宫的一般方法。由于场地漆黑，根据两手获得的墙壁触摸信息可以做出判断，我们称沿左侧行走的方法为左手法则走，称沿右侧行走的方法为右手法则走。让机器人假设按左手法则行走，用左手去摸索左侧的墙壁，以确定前进的方向，同时右手伸向前方，防止在前进的过程中撞到前方拐弯处的墙上。根据两手获得的墙壁的触摸信息做出以下四种判断：.当左、右手都摸不到墙壁时向左前方行走，寻找墙壁以确定前进方向。.当左手摸到墙壁，右手摸不到墙壁时向前方行走。.当左手摸不到墙壁，右手

48、摸到墙壁向左转弯。.当左、右手都摸到墙壁时向右转弯。机器人走迷宫时，可以用机器人的红外传感器来代替人的左、右手，以获取行进中的方向信息，并对获取的红外信号信息做出判断，以决定下一步机器人的行走方向。场地的搭建 搭建一个如图2-87所示的迷宫场地。图2-87程序设计拖动条件循环到主程序下，设置条件循环为永远循环。拖动条件判断到永远循环，设置条件判断，当前方或左方45红外测到有障碍的时候机器人向右转；如果前方和45红外都没测到障碍再判断左方红外是否测到障碍，如果有障碍就一直前进，否则左转，流程图及C语言程序如图2-88所示。图2-88仿真运行图2-89第三章稳步前进在本章中，读者将用到智能机器人的

49、感觉系统。智能机器人的感觉是由传感器实现的。智能机器人装备的传感器有红外传感器、光敏传感器、碰撞传感器、声音传感器、光电编码器、地面灰度传感器等6 种。读者通过做本章的机器人工程，就能熟悉机器人的传感器工作原理。第十一课 走正方形学习任务之前学习了灰度传感器的使用，了解了灰度传感器走黑线的应用，本节课我们继续学习使用灰度传感器，通过这次活动，学习灰度走较复杂轨迹线的程序编写。本节课用第九课搭建的机器人策略分析 本工程是要做一个让机器人能沿着如下图的类似正方形的轨迹线行走，从粉色的起点出发沿着左边的黑色轨迹线行走到黄色终点位置停顿。要求不能脱离黑色轨迹线行走。前面我们学习了机器人沿黑线走的方法，

50、这里我们可以安装两个灰度传感器骑线走轨迹。场地的搭建1在画图工具中将黑色的轨迹线画好，属性设置为300300像素，保存为JPEG格式。并将此图片文件复制到仿真软件的安装目录下。2翻开仿真软件，进入场地编辑界面，鼠标右键单击空白场地，选择设置属性。翻开如图3-1所示的界面。图3-1在此界面上，左边参数设置栏的地图下拉菜单中选择走正方形点击确定就可以将走正方形的轨迹图添加到场景中了。3在场地中添加起点和终点，具体位置如图3-2所示。图3-2添加好后保存场地并命名为走正方形场地。程序设计1)先编写一个机器人走轨迹的子程序。方法是，鼠标右键单击编程区域的空白处，选择新建子程序，进入子程序对话框。命名为

51、guiji，注意子程序命名只能用数字和字母并且必须以字母开头。如图3-4所示。图3-3名称命名好之后点击确认按钮保存子程序。然后编写子程序。子程序如图3-4所示。图3-42子程序编好之后，在程序选择下拉菜单中选择主程序回到主程序编辑界面。在主程序中编写程序如图3-5所示。图3-5程序编写完成后保存程序并命名为走正方形程序。仿真运行图3-6第十二课 赛车学习任务本节课我们继续学习灰度传感器的应用及指南针传感器的综合应用。通过本节课学习，要知晓指南针传感器的用法及运用指南针传感器转弯的方法。策略分析 本工程是要做一个让机器人能沿着如下图的类似T字型的轨迹通道行走，从粉色的起点出发沿着通道走到黄色终

52、点位置停顿。要求不能超越轨迹线行走。针对本节课的任务，我们可以给机器人安装一个指南针传感器。让机器人一直直走到黄色线，然后利用指南针右转一定角度，然后继续直走就可以走到终点的位置。场地的搭建1在画图工具中将如上图所示的轨迹线画好，属性设置为300300像素，保存为JPEG格式。并将此图片文件复制到仿真软件的安装目录下。2翻开仿真软件，进入场地编辑界面，鼠标右键单击空白场地，选择设置属性。翻开如图3-7所示的界面。图3-7在此界面上，左边参数设置栏的地图下拉菜单中选择赛车点击确定就可以将走赛车工程的轨迹图添加到场景中了。3在场地中添加起点和终点，具体位置如图3-8所示。图3-8添加好后保存场地并

53、命名为赛车场地。机器人的搭建本课我们要用到指南针传感器，所以我们在第九课中搭建的机器人的根底上再添加一个指南针传感器。翻开第九课搭建的机器人，选择传感器组别中的指南针传感器，安装到机器人上，并设置端口为6号口。如图3-9所示。图3-9设置好后点击右下角完成按钮保存机器人并命名为赛车机器人。注：指南针传感器的返回值是0到360，反映的是0到360一周的角度。安装指南针传感器的时候注意坐标系的一致性，保证指南针的坐标和机器人整体的坐标一致。指南针的0朝向默认为机器人加载到场地中之后机器人前方的朝向，也就此方向指南针返回0。顺时针返回0到360程序设计1) 先查看一下黄色线条灰度传感器的返回值是多少

54、。方法是进入机器人搭建界面，在添加部件模块的上方有仿真工具按钮，点击仿真工具按钮。在地图列表里选择赛车，鼠标放在地图的任意位置都可以显示相应的灰度值。图中返回值就是黄色线条的返回值。如图3-10所示。图3-102编写程序如图3-11所示。图3-11程序编写完成后保存程序并命名为赛车程序。仿真运行图3-12第十三课 曲棍球比赛学习任务本节课我们将学习灰度传感器、指南针传感器和红外传感器走迷宫的综合应用。策略分析 本工程是要做一个让机器人能从起点出发，经过特定黑线，特定黑线能控制相应的活动门。只要机器人经过特定黑线，相应的活动门就会自动翻开。选择合理的路线到达终点位置停顿。标注如图3-13所示。针

55、对本节课的任务，我们可以选择机器人走活动门1。机器人从起点出发走到第三条黑线的位置，左转一定角度，前行到前方的红外测到挡板为止，然后利用指南针传感器左转一定角度，稍偏右一点前行到左方或45度的红外测到挡板，最后走左手迷宫一直走到终点。特定黑线3特定黑线2特定黑线1活动门2活动门1活动门3图3-13场地的搭建1在画图工具中将场地中需要的黑色轨迹线画好，属性设置为300300像素，保存为JPEG格式。并将此图片文件复制到仿真软件的安装目录下。2翻开仿真软件，进入场地编辑界面，鼠标右键单击空白场地，选择设置属性。翻开如图3-14所示的界面。图3-14在此界面上，左边参数设置栏的地图下拉菜单中选择赛车

56、点击确定就可以将走赛车工程的轨迹图添加到场景中了。3在场地中添加起点、终点、迷宫挡板及活动门，具体形态如图3-15所示。图3-15添加好后保存场地并命名为曲棍球场地。机器人的搭建在前面几节课中搭建的机器人根底上添加一些传感器。搭建完成后如图3-16所示。图3-16设置好后点击右下角完成按钮保存机器人并命名为曲棍球机器人。程序设计1)编写左手迷宫子程序，如图3-17所示。图3-172编写主程序如图3-18所示。图3-18程序编写完成后保存程序并命名为曲棍球比赛。仿真运行图3-19第十四课 避障学习任务本节课我们继续学习稳固红外传感器走迷宫的应用。策略分析 本工程是要做一个让机器人能从起点出发，避

57、开陷阱，陷阱是黑色的方块。避开陷阱，绕过随机出现的障碍物-蓝色墙壁，然后机器人继续沿墙壁行走到达终点，即为完成任务。图3-20场地的搭建1在场地中添加起点、终点、黑色方块信息点、迷宫挡板及活动门方体，具体形态如前面图3-20所示。场地编辑完成后保存场地并命名为避障场地。机器人的搭建搭建机器人如图3-21所示。图3-21设置好后点击右下角完成按钮保存机器人并命名为避障机器人。程序设计分析本节课要完成的任务，其实只要机器人一直走右手迷宫就可以实现机器人既碰不到陷阱又可以到达终点位置完成任务。1)编写右手迷宫子程序，如图3-22所示。图3-222编写主程序如图3-23所示。图3-23程序编写完成后保

58、存程序并命名为避障。仿真运行仿真界面如图3-24所示。图3-24第十五课 街道灭火学习任务本节课我们学习红外传感器走迷宫然后利用火焰传感器找火并灭火的知识。通过本节课学习，要熟悉火焰传感器的灵活应用。策略分析 本工程是要做一个让机器人能从起点出发，避开陷阱，陷阱是黑色的方块。避开陷阱，绕过随机出现的障碍物-蓝色墙壁，然后机器人继续沿墙壁行走到达终点，即为完成任务。图3-25场地的搭建画好黑色线条的图片文件复制到仿真安装目录的Map文件夹下。翻开场地编辑界面，将地图找到，然后再在场地中添加起点、终点、迷宫挡板及活动门方体，具体形态如前面图3-25所示。场地编辑完成后保存场地并命名为街道灭火场地。

59、机器人的搭建搭建机器人如图3-26所示。其中火焰传感器接在6号端口，风扇电机接在2号电机接口。图3-26设置好后点击右下角完成按钮保存机器人并命名为街道灭火机器人。程序设计分析本节课要完成的任务，机器人只要沿着右手迷宫行走就可以走到黑线的位置，机器人一旦碰到黑线就停顿两秒，等到活动门翻开后继续走右手迷宫直到火焰传感器检测到火焰。测到火焰后停下来启动风扇，直到将火焰吹灭。然后停顿所有电机即为完成任务。1)编写右手迷宫子程序，如图3-27所示。图3-272编写主程序如图3-28所示。图3-28程序编写完成后保存程序并命名为街道灭火程序。仿真运行仿真界面如图3-29所示。图3-29第十六课 消防员灭

60、火学习任务本节课综合了各种传感器的综合应用，程序也较复杂，学习本课，我们要理清思路，学会一步一步地编写、调试程序。策略分析机器人从起点出发，沿黑色轨迹线行走，并通过桥洞和小河。机器人行进中检测圆柱形随机障碍物需停顿2秒，否则无法通过。时间计时2秒完毕后，该圆柱形障碍物会自动消失，然后继续沿轨迹线行走。机器人到达A区的T字路口启动风扇进展灭火。将火焰熄灭后停在A区的终点位置即为完成任务。图3-30场地的搭建画好黑色轨迹线的图片文件复制到仿真安装目录的Map文件夹下。翻开场地编辑界面，将地图找到，然后再在场地中添加起点、终点、通道挡板及火焰，具体形态如前面图3-30所示。场地编辑完成后保存场地并命