2023年智能机器人功能开发与设计

智能机器人一功能开发与设计

此京理工人学

自劭化学浣

内容简介

本书主要针对近几年应用比较广泛的智能机器人做了详细的分析介绍，全

面阐述了智能机器人的基本理论与应用。全书共分成了两大部分，第一部分着重

介绍智能机器人的软件和硬件；第二部分主要针对智能机器人的功能开发与设计

做了详细的介绍。

本书通过查阅大量的资料，在智能机器人的功能方面做出了进一步的开发

设计，拓展了智能机器人的应用范围。将功能比较齐全、应用广泛的几大类传感

器应用到智能机器人上，使智能机器人实现相应的功能。书中在第二部分做了详

细的阐述。

本书可以作为专业技能院校在传感器理论及应用方面的教科书，亦可供从

事智能机器人研究的各专业工程技术人员自学参考。

图书编目数据

智能机器人一功能开发与设计/姚小兰主编.一北京：北京理工大学，2013

普通专业技能院校教材g《智能机器人一功能开发与设计》

IX智资Hx姚第HIx智能机器人-专业技能院校-教材

北京理工大学g自动化学院

智能机器人项目主要参加人员：

北京理工大学：姚小兰、李保奎、于蕾、张东洋、苗江涛、张家鑫、高双

广州市公用事业技师学院：周俊林、李照勋、张瑞佳、陆天智

本书由北京理工大学自动化学院编辑

地址：北京市海淀区中关村南大街5号

邮编：100089

电话/p>

目录

1.智能机器人概述.................................................1

1.1智能机器人硬件介绍............................................1

1.1.1概述.......................................................1

1.1.2电机的安装.................................................2

1.1.3LCD显示屏的安装..........................................2

1.2智能机器人软件介绍...........................................3

1.2.1CPU内程序................................................3

1.2.2上位机界面.................................................5

2.功能介绍及测试.................................................8

2.1通讯设置......................................................8

2.2超声波测距...................................................9

2.2.1功能说明...................................................9

2.2.2操作说明...................................................9

2.2.3程序流程..................................................11

2.3红外线避障功能...............................................13

2.3.1功能说明..................................................13

2.3.2操作说明..................................................13

2.3.3实现方法..................................................15

2.3.4程序流程..................................................15

2.4超声波避障功能...............................................16

2.4.1功能说明..................................................16

2.4.2功能试验操作说明..........................................16

2.4.3实现方法..................................................18

2.4.4程序流程..................................................18

2.5超声波+红外线避障功能........................................19

2.5.1功能说明..................................................19

2.5.2操作说明..................................................19

2.5.3实现方法..................................................21

2.5.4程序流程..................................................21

2.6寻找火源....................................................22

2.6.1功能说明..................................................22

2.6.2功能试验操作说明..........................................22

2.6.3实现方法..................................................23

2.6.4程序流程.................................................23

2.7灯光控制....................................................24

2.7.1功能说明..................................................24

2.7.2功能试验操作说明..........................................24

2.7.3实现方法..................................................26

2.7.4程序流程.................................................26

2.8寻线功能....................................................27

2.8.1功能说明..................................................27

2.8.2功能试验操作说明..........................................27

2.8.3实现方法..................................................29

2.8.4程序流程.................................................29

附录：智能机器人传感器变量汇总....................................30

1.智能机器人概述

智能机器人系统采用三片CPU,分别挂接不同传感器，配合相应程序，完

成不同功能。

1.1智能机器人硬件介绍

1.1.1概述

系统主要由三片CPU、电机、LCD显示屏、若干传感器、接口、开关及辅

助电路构成。

与CPU1相连的接口及传感器主要有遥控接收器、LCD显示屏、LED指示

灯、程序下装口和通讯接口，配合程序完成遥控、编程、LCD显示和通讯功能。

与CPU2相连的接口及传感器主要有超声波传感器、红外避障传感器、碰撞

开关、震动传感器、倾角传感器、温度传感器、温湿度传感器、LED指示灯、

程序下装口和通讯接口，配合程序完成超声波测距、红外避障、温湿度测量、编

程和通讯等功能。

与CPU3相连的接口及传感器主要有电机、三轴加速度计、灰度传感器、火

焰传感器、烟雾传感器、酒精传感器、光线传感器、颜色传感器、LED指示灯、

程序下装口和通讯接口，配合程序完成机器人移动、寻线、寻找火源、编程和通

讯等功能。

系统主要的硬件连接如图1-1所示，其中，图l-l(a)是未安装传感器时系统

硬件连接图，图l-l(b)是整体硬件连接图。

图l-l(a)未安装传感器系统硬件连接

图l-l(b)整体硬件连接

1.1.2电机的安装

智能机器人系统采用两个电机分别驱动两个轮子，用户可以对两个电机分别

进行控制，以完成前进、后退、转弯等多种动作。电机的安装如图1-2所示：

图1-2电机的安装

安装电机时，左侧电机连接线与M0T1接口相连；电机连接线与M0T2接

口相连；同时，注意三根连接线的颜色位置。

1.1.3LCD显示屏的安装

智能机器人系统可采用LCD显示屏来显示各个传感器的数据，其通过连接

线与接口板相连，安装如图1-3所示：

2

图1-3LCD的安装

在安装LCD显示屏时，注意接口板上各个信号引脚与LCD上的各个信号引

脚要一一对应。

1.2智能机器人软件介绍

系统软件部分包含CPU内程序部分和上位机界面两个部分。

1.2.1CPU内程序

CPU1作为主CPU,包含的程序如下：

(l)LCD显示程序，使数据在机器人上的显示；

(2)与上位机通讯程序，实现接收上位机命令、处理分解命令以及向上位机

回送命令、传感器配置信息和实时数据的功能；

(3)与CPU2、CPU3通讯程序，用来向从CPU发送与接收命令和数据；

(4)遥控程序，读取遥控器按键编码；

(5)基本测试程序，通过向从CPU发送与接收的命令和数据，完成对传感器

各项功能的基本测试；

(6)电机速度设定程序，用来设定机器人电机的目标速度；

(7)各项功能程序，通过向从CPU发送与接收的命令和数据以及多种传感器

的配合，实现寻线、红外避障、超声波测距、红外+超声波避障、寻找火源等功

能；

(8)开放程序，用户可通过调用从CPU的各项传感器数据，配合自身设计的

算法，实现相应的功能。

CPU2作为从CPU,包含的程序如下：

3

(1)与CPU1的通讯程序，接收来自CPU1的命令和数据、并向CPU1发送请

求数据；

⑵实现各种功能的程序，实现检测传感器数据功能，以及各传感器的启动、

运行、读取数据的功能。

CPU3作为从传感器，包含的程序如下：

(1)与CPU1通讯程序，接收来自CPU1的命令和数据、并向CPUI发送请求

数据；

(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对结果等数据内容进行显示，可采用如下语句格式：

4

sprintf（stLCD.Rowl,"格式"茂量）；〃第一行显示内容，没有可删除

sprintf（stLCD.Row2,“格式"，变量）；〃第二行显示内容，没有可删除

stLCD.ShowReq=1;

在上述语句中，变量stLCD.ShowReq控制显示方式，共有三种取值：一种

是只显示第一行，一种是只显示第二行，还有一种是显示两行。"格式"在使用中

用需要显示内容的输出格式代替，如"$PRINTDistance:%dmm\n"。

1.2.2上位机界面

上位机界面分为通讯设置、传感器设置、演示实验和调试四个界面，如图

1-4、1-5、1-6和1-7所示，用户可根据后续章节介绍了解上位机界面的操作。

图1-4通讯设置

5

图1-5传感器设置

图1-6演示实验

6

图1-7调试

7

2.功能介绍及测试

2.1通讯设置

PC机与智能机器人需要通过通讯接口来实施控制。因此，需要在PC机上进

行一定的配置。配置方法如下：

（1）通过USB线连接PC机和智能机器人，将两个开关拨到合适的位置。

（2）在“计算机”上单击右键，点击“管理”，双击“设备管理器”，如图

2-1所示。

,艮•算机管理

旦文件G）操作3）查看（V）窗口的帮助00

的甯哈图丽

国计篁机管理建地）名称

-蠹系统工具以系统工具

中向事件查看器理存健

+rJ共享文件夹虫服务和应用程序

I+.施本地用户和蛆

+知性能日志和警报

u宴记客曾迎器’n

4岁可移动存储

B磁盘碎片整理程序

密磁盘管理

+除服务和应用程序

图2-1设备管理器

（3）在“端口（COM和LPT）”中查看与智能机器人连接的通讯端口号，如

图2-2所示，此处的端口号为COM5（各PC机的端口号可能不同）。

8

图2-2通讯端口

(4)在PC机上打开parasetup软件。在通讯设置选择端口号，此处为C0M5,

并点击连接。此时窗口下方应显示“已连接C0M5”。

图2-3通讯配置

2.2超声波测距

2.2.1功能说明

测量位于机器人前方障碍物距机器人的距离，并显示在计算机屏幕上，或显

示在机器人LCD显示屏上。

2.2.2操作说明

(1)安装传感器

9

该功能采用的传感器为超声波传感器，安装在接口板“SR04”处，如图2-4所

示:

图2-4超声波传感器与智能机器人的连接

⑵勾选传感器设置中“超声波测距"HC-SR04”项，如图2-5所示，下装传感

器配置至机器人，打开“演示实验”中超声波测距显示，如图2-6所示。

图2-5超声波测距传感器配置

10

图2-6超声波测距显示功能选择

2.2.3程序流程

图2-7超声波传感器测距程序流程图

图2-8数据转换程序流程图

图2-9显示距离程序流程图

11

开始

图2-7超声波传感器测距流程图图2-8数据转换流程图

12

图2-9显示距离流程图

2.3红外线避障功能

2.3.1功能说明

在行进过程中探测位于机器人左前方或右前方的障碍物并有效地避开障碍

物继续前进

2.3.2操作说明

(1)安装传感器

该功能采用的传感器为两个红外线避障传感器，安装在接口板“IR2”

处，如图如10所示:

13

图2-10红外避障传感器与智能机器人的连接

（2）在传感器设置中勾选“红外避障传感器（左）”、“红外避障传感器（右）”,

将设置下装到机器人中，如图2-11所示，并在“演示试验”界面打开“红外避障”,

运行机器人，如图2-12所示。

图2-11红外避障传感器配置

14

图2-12红外避障功能选择

2.3.3实现方法

机器人左右两侧各装一个红外线传感器，分别控制左右两侧的电机，用于探

测左前方及右前方的障碍物，若左前方有障碍物，则向左侧电机发送信号，使左

侧电机快速转动，右侧电机速度为零，机器人右转；若右前方有障碍物，则向右

侧点击发送信号，使右侧电机快速转动，左侧电机速度为零，机器人左转；若左

右两侧均有障碍物，则控制左侧电机速度为零，右侧电机快速转动，机器人左转;

若左右两侧均无障碍物则左右两侧电机均快速转动。

2.3.4程序流程

程序流程图如图2-13所示：

15

开始

图2-13红外避障程序流程

2.4超声波避障功能

2.4.1功能说明

利用超声波传感器避开机器人前方2.2m以内的障碍物

2.4.2功能试验操作说明

(1)安装传感器

该功能采用超声波传感器和两个红外避障传感器，安装在接口板“SR04”处,

如图2-14所示：

16

图2-14超声波传感器与智能机器人的连接

(2)在传感器设置中勾选“超声波测距HC-SR04",将设置下装到机器人中,

如图2-15所示，并在“演示试验”界面打开"超声波避障“，运行机器人，如

图2-16所示。

图2-15超声波避障传感器配置

17

图2-16超声波避障功能选择

2.4.3实现方法

目的是利用超声波传感器探测障碍物的距离。当障碍物的距离大于200cm

时，保持小车原来的速度；当障碍物的距离小于200cm时，使左侧电机的速度

为零，右侧电机的保持不变，从而避开障碍物。

2.4.4程序流程

程序流程图如图2-17所示

图2-17超声波避障程序流程

18

2.5超声波+红外线避障功能

2.5.1功能说明

同时启用超声波和红外线传感器，避开前方一定距离内的障碍物。

2.5.2操作说明

(1)安装传感器

该功能采用的传感器为超声波传感器和两个红外避障传感器，其安装位置为

接口板“SR04"、“IR2”处，如图2-18(a)、(b)所示：

图2-18(a)超声波传感器与智能机器人的连接

图2-18(b)红外避障传感器与智能机器人的连接

(2)在传感器设置中同时勾选“超声波测距HC-SR04”、“红外避障传感器

(左)”、“红外避障传感器(右”'，将设置下装到机器人中，如图2-19所示，并

19

在“演示试验”界面打开"超声+红外避障“，运行机器人，如图2-20所示。

图2-19红外+超声波避障传感器配置

图2-20红外+超声波避障功能选择

20

2.5.3实现方法

利用超声波传感器探测障碍物的距离，当距离大于220cm时，保持机器人

全速行进；当距离小于220cm时，利用红外线传感器探测障碍物的方位，若位

于左侧，使左侧电机快速转动，使右侧电机停止转动；若位于右侧，使右侧电机

快速转动，使左侧电机停止转动；若两侧均有障碍物，使左侧电机停止转动，右

侧电机快速转动；若障碍物位于正前方，使左右两侧电机慢速转动。

2.5.4程序流程

程序流程图如图2-21所示

图2-21红外+超声波避障程序流程

21

2.6寻找火源

2.6.1功能说明

使机器人寻找周围环境中的火源

2.6.2功能试验操作说明

(1)安装传感器

该功能采用两个火焰传感器，安装在接口板”Firel"、"Fire2”处，如图2-19

所示：

图2-19火焰传感器与智能机器人的连接

(2)在传感器设置中同时勾选“火焰传感器(左)“、”火焰传感器(右)”

将设置下装到机器人中，如图2-20所示，并在“演示试验”界面打开”寻找火

源”，运行机器人，如图2-21所示。

图2-20寻找火源传感器配置

22

图2-21寻找火源功能选择

2.6.3实现方法

利用火焰传感器采集周围环境的信息，再将采集到的模拟信息通过A/D转

换器转换成数字量再进一步转换成距离。若两侧火焰传感器测得的距离均小于

0.45m,则两侧电机速度均为零一一找到火源；若两侧距离大于0.45m,且两侧

距离差小于0.1m,则两侧电机同速转动，使智能机器人直线前进；若两侧距离

大于0.45m且右侧距离小于左侧距离，保持右侧电机转速为零，左侧电机保持转

动，机器人右转，靠近光源；若两侧距离大于0.45m且右侧距离大于左侧距离，

控制左侧电机转速为零，右侧电机保持转动，机器人左转，靠近光源。

2.6.4程序流程

程序流程图如图2-22所示

23

图2-22寻找火源程序流程

2.7灯光控制

2.7.1功能说明

机器人根据周围环境的光线强度，控制灯光的亮度。

2.7.2功能试验操作说明

(1)安装传感器

该功能采用光线传感器，安装在接口板“Light”处，如图2-23所示:

24

图2-23光线传感器与智能机器人的连接

(2)在传感器设置中同时勾选“光线传感器”，将设置下装到机器人中，如

图2-24所示，并在“演示试验”界面打开“灯光控制”，运行机器人，如图2-25

所示。

图2-24灯光控制传感器配置

25

图2-25灯光控制功能选择

2.7.3实现方法

机器人采集周围环境中的光线强度，并将采集到的模拟量由A/D转换器转

换成数字量，通过比较环境光照强度和设定的阈值来控制各盏灯的亮灭。

2.7.4程序流程

程序流程图如图2-26所示

图2-26灯光控制程序流程

26

2.8寻线功能

2.8.1功能说明

让机器人按照预定的轨迹行进。

2.8.2功能试验操作说明

(1)安装传感器

该功能采用灰度传感器，安装在接口板“Gray”处，如图2-27所示:

图2-27灰度传感器与智能机渊人的连接

(2)在传感器设置中同时勾选“灰度传感器”，将设置下装到机器人中，如

图2-28所示。并在“演示试验”界面打开“寻线”，运行机器人，如图2-29所

Zjso

27

图2-28寻线功能传感器配置

图2-29寻线功能选择

28

2.8.3实现方法

利用灰度传感器采集当下轨迹的灰度值，灰度传感器如图2-30所示。机器

人不断采集5个位置的灰度，根据5个位置的灰度值控制机器人的运动。

2.8.4程序流程

程序流程图如图2-31所示

图2-31寻线程序流程图

29

附录：智能机器人传感器变量汇总

装置使用变量变量类型变量范围变量访问方式变量含义安装说明

浮点型，精确到小

温度传感器stTemp.t只读温度值，单位为摄氏度CPU2P2A5

数点后两位

温度：stHumidity.t浮点型，精确到小温度和相对湿度值，单

温湿度传感器只读CPU2P2A6

湿度：stHumidity.h数点后两位位为摄氏度和百分比

stGray.gl>

stGray.g2>灰度值，数值越大，灰

灰度传感器整型0~99只读接口板Gray处

stGray.g3、度越低即越白

stGray.g4>stGray.g5

左侧:stFire.Left浮点型，精确到小与火焰的距离，单位为接口板Fire1、Fire2

火焰传感器只读

右侧：stFire.Right数点后两位厘米处

浮点型，精确到小光照强度，数值越大光

光线传感器stLight.d0~99只读接口板Light处

数点后两位照越强

浮点型，精确到小烟雾浓度，单位为百分

烟雾传感器stSmoke.d只读接口板MQ2处

数点后两位比

浮点型，精确到小

气体传感器stAIcohol.d0~99只读酒精浓度，单位为ppm接口板MQ3处

数点后两位

与前方障碍物距离，单

超声波传感器stUltrasonic.d整型只读接口板SR04处

位为毫米

OxfO：左前方有障碍

红外避障传感四种取值：OxfO,OxOf：右前方有障碍

stIR.d整型只读接口板IR1、IR2处

器OxOf、Oxff、0x00Oxff：左右前方有障碍