本科毕业设计-智能机器人功能开发与设计

智能机器人—功能开发与设计北京理工大学自动化学院内容简介本书主要针对近几年应用比较广泛的智能机器人做了详细的分析介绍，全面阐述了智能机器人的基本理论与应用。全书共分成了两大部分，第一部分着重介绍智能机器人的软件和硬件；第二部分主要针对智能机器人的功能开发与设计做了详细的介绍。本书通过查阅大量的资料，在智能机器人的功能方面做出了进一步的开发设计，拓展了智能机器人的应用范围。将功能比较齐全、应用广泛的几大类传感器应用到智能机器人上，使智能机器人实现相应的功能。书中在第二部分做了详细的阐述。本书可以作为专业技能院校在传感器理论及应用方面的教科书，亦可供从事智能机器人研究的各专业工程技术人员自学参考。图书编目数据智能机器人—功能开发与设计/姚小兰主编.—北京：北京理工大学，2013普通专业技能院校教材《智能机器人—功能开发与设计》=1\*ROMANI智=2\*ROMANII姚=3\*ROMANIII智能机器人-专业技能院校-教材北京理工大学自动化学院智能机器人项目主要参加人员：北京理工大学：姚小兰、李保奎、于蕾、张东洋、苗江涛、张家鑫、高双广州市公用事业技师学院：周俊林、李照勋、张瑞佳、陆天智本书由北京理工大学自动化学院编辑地址：北京市海淀区中关村南大街5号邮编：100089电话AGEII目录1.智能机器人概述 11.1智能机器人硬件介绍 11.1.1概述 11.1.2电机的安装 21.1.3LCD显示屏的安装 21.2智能机器人软件介绍 31.2.1CPU内程序 31.2.2上位机界面 52.功能介绍及测试 82.1通讯设置 82.2超声波测距 92.2.1功能说明 92.2.2操作说明 92.2.3程序流程 112.3红外线避障功能 132.3.1功能说明 132.3.2操作说明 132.3.3实现方法 152.3.4程序流程 152.4超声波避障功能 162.4.1功能说明 162.4.2功能试验操作说明 162.4.3实现方法 182.4.4程序流程 182.5超声波+红外线避障功能 192.5.1功能说明 192.5.2操作说明 192.5.3实现方法 212.5.4程序流程 212.6寻找火源 222.6.1功能说明 222.6.2功能试验操作说明 222.6.3实现方法 232.6.4程序流程 232.7灯光控制 242.7.1功能说明 242.7.2功能试验操作说明 242.7.3实现方法 262.7.4程序流程 262.8寻线功能 272.8.1功能说明 272.8.2功能试验操作说明 272.8.3实现方法 282.8.4程序流程 28附录：智能机器人传感器变量汇总 30PAGE311.智能机器人概述智能机器人系统采用三片CPU，分别挂接不同传感器，配合相应程序，完成不同功能。1.1智能机器人硬件介绍1.1.1概述系统主要由三片CPU、电机、LCD显示屏、若干传感器、接口、开关及辅助电路构成。与CPU1相连的接口及传感器主要有遥控接收器、LCD显示屏、LED指示灯、程序下装口和通讯接口，配合程序完成遥控、编程、LCD显示和通讯功能。与CPU2相连的接口及传感器主要有超声波传感器、红外避障传感器、碰撞开关、震动传感器、倾角传感器、温度传感器、温湿度传感器、LED指示灯、程序下装口和通讯接口，配合程序完成超声波测距、红外避障、温湿度测量、编程和通讯等功能。与CPU3相连的接口及传感器主要有电机、三轴加速度计、灰度传感器、火焰传感器、烟雾传感器、酒精传感器、光线传感器、颜色传感器、LED指示灯、程序下装口和通讯接口，配合程序完成机器人移动、寻线、寻找火源、编程和通讯等功能。系统主要的硬件连接如图1-1所示，其中，图1-1(a)是未安装传感器时系统硬件连接图，图1-1(b)是整体硬件连接图。图1-1(a)未安装传感器系统硬件连接图1-1(b)整体硬件连接1.1.2电机的安装智能机器人系统采用两个电机分别驱动两个轮子，用户可以对两个电机分别进行控制，以完成前进、后退、转弯等多种动作。电机的安装如图1-2所示：图1-2电机的安装安装电机时，左侧电机连接线与MOT1接口相连；电机连接线与MOT2接口相连；同时，注意三根连接线的颜色位置。1.1.3LCD显示屏的安装智能机器人系统可采用LCD显示屏来显示各个传感器的数据，其通过连接线与接口板相连，安装如图1-3所示：图1-3LCD的安装在安装LCD显示屏时，注意接口板上各个信号引脚与LCD上的各个信号引脚要一一对应。1.2智能机器人软件介绍系统软件部分包含CPU内程序部分和上位机界面两个部分。1.2.1CPU内程序CPU1作为主CPU，包含的程序如下：(1)LCD显示程序，使数据在机器人上的显示；(2)与上位机通讯程序，实现接收上位机命令、处理分解命令以及向上位机回送命令、传感器配置信息和实时数据的功能；(3)与CPU2、CPU3通讯程序，用来向从CPU发送与接收命令和数据；(4)遥控程序，读取遥控器按键编码；(5)基本测试程序，通过向从CPU发送与接收的命令和数据，完成对传感器各项功能的基本测试；(6)电机速度设定程序，用来设定机器人电机的目标速度；(7)各项功能程序，通过向从CPU发送与接收的命令和数据以及多种传感器的配合，实现寻线、红外避障、超声波测距、红外+超声波避障、寻找火源等功能；(8)开放程序，用户可通过调用从CPU的各项传感器数据，配合自身设计的算法，实现相应的功能。CPU2作为从CPU，包含的程序如下：(1)与CPU1的通讯程序，接收来自CPU1的命令和数据、并向CPU1发送请求数据；(2)实现各种功能的程序，实现检测传感器数据功能，以及各传感器的启动、运行、读取数据的功能。CPU3作为从传感器，包含的程序如下：(1)与CPU1通讯程序，接收来自CPU1的命令和数据、并向CPU1发送请求数据；(2)实现各种功能的程序，实现检测传感器数据功能以及各传感器启动、运行、读取数据的功能。(3)电机控制程序，根据CPU1的命令，实现对电机目标速度的控制。为了方便用户的自主开发，针对电机和LCD显示屏，可按照如下方式进行控制：(1)电机控制使用变量stMotor.SpeedLeft和stMotor.SpeedRight对左右电机进行控制，二者有四种取值：MOT_SPD_FULL、MOT_SPD_FAST、MOT_SPD_SLOW、MOT_SPD_ZERO，分别表示全速正转、高速正转、低速正转和静止。若需控制电机反转，则用0减去相应的取值即可。通过上述取值的不同组合，可以实现前进、后退、转弯等运动方式。电机控制的具体语句为(以全速前进为例)：{...stMotor.SpeedLeft=MOT_SPD_FULL;stMotor.SpeedRight=MOT_SPD_FULL;…stMotor.SpeedControl=FALSE;stUART2.CPU3SendMotorReq=TRUE;}若用户在程序中对电机进行操作，那么在程序的结尾处需要加入上述语句中的最后两句，以使前述控制生效。(2)LCD显示若用户需用LCD对结果等数据内容进行显示，可采用如下语句格式：{...sprintf(stLCD.Row1,"格式",变量);//第一行显示内容，没有可删除sprintf(stLCD.Row2,"格式",变量);//第二行显示内容，没有可删除stLCD.ShowReq=1;...}在上述语句中，变量stLCD.ShowReq控制显示方式，共有三种取值：一种是只显示第一行，一种是只显示第二行，还有一种是显示两行。"格式"在使用中用需要显示内容的输出格式代替，如"$PRINTDistance:%dmm\n"。1.2.2上位机界面上位机界面分为通讯设置、传感器设置、演示实验和调试四个界面，如图1-4、1-5、1-6和1-7所示，用户可根据后续章节介绍了解上位机界面的操作。图1-4通讯设置图1-5传感器设置图1-6演示实验图1-7调试

2.功能介绍及测试2.1通讯设置PC机与智能机器人需要通过通讯接口来实施控制。因此，需要在PC机上进行一定的配置。配置方法如下：（1）通过USB线连接PC机和智能机器人，将两个开关拨到合适的位置。（2）在“计算机”上单击右键，点击“管理”，双击“设备管理器”，如图2-1所示。图2-1设备管理器（3）在“端口（COM和LPT）”中查看与智能机器人连接的通讯端口号，如图2-2所示，此处的端口号为COM5（各PC机的端口号可能不同）。图2-2通讯端口（4）在PC机上打开parasetup软件。在通讯设置选择端口号，此处为COM5，并点击连接。此时窗口下方应显示“已连接COM5”图2-3通讯配置2.2超声波测距2.2.1测量位于机器人前方障碍物距机器人的距离，并显示在计算机屏幕上，或显示在机器人LCD显示屏上。2.2.2(1)安装传感器该功能采用的传感器为超声波传感器，安装在接口板”SR04”图2-4超声波传感器与智能机器人的连接(2)勾选传感器设置中“超声波测距”HC-SR04”项,如图2-5所示，下装传感器配置至机器人，打开“演示实验”中超声波测距显示，如图2-6图2-5超声波测距传感器配置图2-6超声波测距显示功能选择2.2.3图2-7超声波传感器测距程序流程图图2-8数据转换程序流程图图2-9显示距离程序流程图

图2-7超声波传感器测距流程图图2-8数据转换流程图图2-9显示距离流程图2.3红外线避障功能2.3.1在行进过程中探测位于机器人左前方或右前方的障碍物并有效地避开障碍物继续前进2.3.(1)安装传感器该功能采用的传感器为两个红外线避障传感器，安装在接口板”IR1”、”IR2”处，如图2-图2-10红外避障传感器与智能机器人的连接(2)在传感器设置中勾选“红外避障传感器（左）”、“红外避障传感器（右）”，将设置下装到机器人中，如图2-11所示，并在“演示试验”界面打开”红外避障“，运行机器人，如图2-12所示。图2-11红外避障传感器配置图2-12红外避障功能选择2.3.3机器人左右两侧各装一个红外线传感器，分别控制左右两侧的电机，用于探测左前方及右前方的障碍物，若左前方有障碍物，则向左侧电机发送信号，使左侧电机快速转动，右侧电机速度为零，机器人右转；若右前方有障碍物，则向右侧点击发送信号，使右侧电机快速转动，左侧电机速度为零，机器人左转；若左右两侧均有障碍物，则控制左侧电机速度为零，右侧电机快速转动，机器人左转；若左右两侧均无障碍物则左右两侧电机均快速转动。2.3.4程序流程图如图2-13所示：图2-13红外避障程序流程2.4超声波避障功能2.4.1利用超声波传感器避开机器人前方2.2m以内2.4.2(1)安装传感器该功能采用超声波传感器和两个红外避障传感器，安装在接口板”SR04”处，如图2-14图2-14超声波传感器与智能机器人的连接(2)在传感器设置中勾选“超声波测距HC-SR04“，将设置下装到机器人中，如图2-15所示，并在“演示试验”界面打开”超声波避障“，运行机器人，如图2-16所示。图2-15超声波避障传感器配置图2-16超声波避障功能选择2.4.目的是利用超声波传感器探测障碍物的距离。当障碍物的距离大于200cm时，保持小车原来的速度；当障碍物的距离小于200cm时，使左侧电机的速度为零，右侧电机的保持不变，2.4.4程序流程图如图2-17所示图2-17超声波避障程序流程2.5超声波+红外线避障功能2.5.1同时启用超声波和红外线传感器，避开前方一定距离内的障碍物。2.5.2(1)安装传感器该功能采用的传感器为超声波传感器和两个红外避障传感器，其安装位置为接口板”SR04”、”IR1”、”IR2”处，如图2-18(a)、(b)图2-18(a)超声波传感器与智能机器人的连接图2-18(b)红外避障传感器与智能机器人的连接(2)在传感器设置中同时勾选“超声波测距HC-SR04”、“红外避障传感器（左）”、“红外避障传感器（右）”，将设置下装到机器人中，如图2-19所示，并在“演示试验”界面打开”超声+红外避障“，运行机器人，如图2-20所示图2-19红外+超声波避障传感器配置图2-20红外+超声波避障功能选择2.5.3利用超声波传感器探测障碍物的距离，当距离大于220cm时，保持机器人全速行进；当距离小于220cm时，利用红外线传感器探测障碍物的方位，若位于左侧，使左侧电机快速转动，使右侧电机停止转动；若位于右侧，使右侧电机快速转动，使左侧电机停止转动；若两侧均有障碍物，使左侧电机停止2.5.4程序流程图如图2-21所示低速前进是否是否是否是低速前进是否是否是否是否是否是高速左转结束低速右转障碍距离大于1.障碍距离小于1.左右前方有障碍高速左转右前方有障碍全速前进左前方有障碍高速右转开始障碍距离大于2.2m且左右前方均无障碍否2.6寻找火源2.6.1使机器人寻找周围环境中的火源2.6.(1)安装传感器该功能采用两个火焰传感器，安装在接口板”Fire1”、”Fire2图2-19火焰传感器与智能机器人的连接(2)在传感器设置中同时勾选“火焰传感器（左）“、“火焰传感器（右）”将设置下装到机器人中，如图2-20所示，并在“演示试验”界面打开”寻找火源“，运行机器人，如图2-21所示。图2-20寻找火源传感器配置图2-21寻找火源功能选择2.6.3利用火焰传感器采集周围环境的信息，再将采集到的模拟信息通过A/D转换器转换成数字量再进一步转换成距离。若两侧火焰传感器测得的距离均小于0.45m，则两侧电机速度均为零——找到火源；若两侧距离大于0.45m，且两侧距离差小于0.1m，则两侧电机同速转动，使智能机器人直线前进；若两侧距离大于0.45m且右侧距离小于左侧距离，保持右侧电机转速为零，左侧电机保持转动，机器人右转，靠近光源；若两侧距离大于0.45m且右侧距离大于左侧距离，控制左侧电机2.6.4程序流程图如图2-22所示图2-22寻找火源程序流程2.7灯光控制2.7.1机器人根据周围环境的光线强度，控制灯光的亮度。2.7.(1)安装传感器该功能采用光线传感器，安装在接口板”Light”处，如图2-23所示：图2-23光线传感器与智能机器人的连接(2)在传感器设置中同时勾选“光线传感器”，将设置下装到机器人中，如图2-24所示，并在“演示试验”界面打开“灯光控制”，运行机器人，如图2-25所示。图2-24灯光控制传感器配置图2-25灯光控制功能选择2.7.机器人采集周围环境中的光线强度，并将采集到的模拟量由A/D转换器转换成数字量，通过比较环境光照强度和设定的阈值来控制各盏灯的亮灭。2.7.程序流程图如图2-26所示图2-26灯光控制程序流程2.8寻线功能2.8.让机器人按照预定的轨迹行进。2.8.(1)安装传感器该功能采用灰度传感器，安装在接口板”Gray”处，如图2-27所示：图2-27灰度传感器与智能机器人的连接(2)在传感器设置中同时勾选“灰度传感器”，将设置下装到机器人中，如图2-28所示。并在“演示试验”界面打开“寻线”，运行机器人，如图2-29所示。图2-28寻线功能传感器配置图2-29寻线功能选择2.8.利用灰度传感器采集当下轨迹的灰度值，灰度传感器如图2-30所示。机器人不断采集5个位置的灰度，根据5个位置的灰度值控制机器人的运动。图2-30灰度传感器位置图2.8.4程序流程图如图2-31所示否是是开始位置3为黑全速前进位置2为黑高速