传感技术学报
CHINESE JOURNAL OF SENSORS AND ACTUATORS
Vol. 31 No. 7July 2018
Desi^^n and Implementation of Multi-robot System Searching
for Hazardous Gas Leakage Source*
CHENYinsheng1* JHAOWenji%,SONGKai2,WANGQi2
$ 1. Harbin University of Science and Techno7^yy, School of Measurement and Communication Engir^ering ,Harbin 150001, China ;
2.Harbin Institute of Techmo7^gy,School of Electrical Enginering and Automation &Harbin 150001, China)
Abstract : Hazardous gas leakage source searching is one of tlie important application fields of bionic olfactory technology. In
order to improve the
efficiency
and
accuracy of gas leakage
source positioning,this paper
plements a multi-robot system searching gas source target based on wireless sensor networl^. This system is composed of multiple olfactory robots & each of which realizes information exchange as a wireless sensor network node, and works together to realize hazardous gas leakage source positioning. DSPprocessor(TMS320F28335) regards as the control core of olfactory robot tliat combines the output signals of MOS gas sensors and wind speed sensors. This paper designs a searching algoritlim for single gas leakage source combining concentration gradient and wind speed information. When the
olfactory robot completes gas
source location,it
will alarm,and the
otlier
robots
sembled microphone array and sound source localization algorithm to realize indirect orientation of the gas source.Finally, in order to illustrate
the effectiveness and
accuracy of
the
proposed
multi-robot systemfor
localization, this paper designs a gas source searching experiment for a single leakage source.
Key words: olfactory robot; robot system ;wireless sensor network ;gas source search'concentration gradientEEACC
:7230 doi: 10C969/j.issn.l004-1699.2018.07.026
危险气体泄漏源搜寻多机器人系统的设计与实现*
陈寅生1!,赵文杰\\宋凯2,王祁2
(1.哈尔滨理工大学测控技术与通信工程学院,哈尔滨150001;2.哈尔滨工业大学电气工程与自动化学院,哈尔滨150001)
主商要:危险气体泄漏源搜寻是仿生嗅觉技术的重要应用领域之一。为了提高气体泄露源定位的效率和准确性,设计并实现
了一种基于无线传感器网络的气源目标搜寻多机器人系统。该系统由多个嗅觉机器人组成,每个机器人作为无线传感器网络节 点实现信息交换,协同工作,实现危险气体泄漏源的定位。嗅觉机器人以DSP处理器(TMS320F28335)为控制核心,对MOS气体 传感器和风速传感器的输出信号进行融合,设计了浓度梯度与风速信息相结合的单一气体泄漏源搜寻算法。当嗅觉机器人完成 气源定位时将发出警报,其他机器人利用装配的麦克风阵列和声源定位算法实现对泄漏源的间接定位。最后,为了说明所设计 的多机器人系统对气体泄露源定位的有效性和准确性,本文设计了针对单一泄露源的气源搜寻实验进行銜I。关键词:嗅觉机器人;机器人系统;无线传感器网络;气源搜寻;浓度梯度中图分类号:TP242.6 文献标识码:A 文章编号:1004-1699(2018)07-1132-09
气源搜寻结合了机器人技术和传感器技术,是 当前仿生嗅觉研究领域中的一个活跃的研究方向。 嗅觉机器人在搜寻易燃易爆气体、危险化学品泄漏、 大气污染源等方面具有潜在的应用价值[M]。
为了对危险气体泄露源进行准确定位,国内外相项目来源:黑龙江省教育厅科技项目(12541141)收稿日期:2018-01-01 修改日期:2018-01 -24
关学者进行了大量的研究工作。Russell和Deveza利 用樟脑铺设了一条路线,设计了安装了两个气体传感
器的嗅觉机器人沿着这条路线行走[?]。此外,Russll 还提出了一种通过跟踪气味烟羽进行气源定位的气 源搜寻算法[5]。Kuwana和Shimoyama将两个昆虫的
第7期陈寅生,赵文杰等:危险气体泄漏源搜寻多机器人系统的设计与实现1133
作为传感器安装在机器人上获 的信息
素,提出 种 信息素烟羽 算法。
KazaT等采用相似的算法控制装 合体传感器的机器人
水
形成的烟羽[6]。Grass〇等研制了
机器奸用来研究龙
和
的方式[7],
该机器人能够在水中移动,利用左右两边装配的气敏 传感器进行导航。Morse等人模 的化学向性,并利用视觉传感器感测 的梯度来对机器人进行导航,实现 学趋向性的算法[&]。TomDucket的团队提出了一种新的理念,利用电子鼻测 羽中与
同距离和不同角度的,利用这些数据对
子鼻进行,使
好的电子鼻
预测
的
距离、运动方向和 方向角等信息, 迅速
[A]。IMEa H等人采用多个 传感器构成一个平 & 感知的数
制烟羽或气体度的 & 同
的浓度差异,判
的方向,
实现 [1%]。浙大学王平课题组
实现大
神经元信号的分析解
码,实现气味检测与,取得
效的
[11]。
S
的分析可知,
用 传感器检测烟羽的
度梯度逐步实现气源搜寻是目前的经济、有效的实 方案[1$]。 是,此类方法仍然
计
搜低等问题。鉴于此, 计一种安装有多个 传感器
和风速传感器的 机器人来检测浓度梯度和风
向,机器人
合
度和风速信息决定移
动方向 , 制 搜
,
实现对
的
。多个
机器人组成多机器人系统,
用无线传感器网络进行协作,提高 效和准确性。 个
机器人
发出警报声,机器人利用装配的麦克风
合
声
算法进行声 ,实现多机器人系统的
协同工作,对露
行间接
。
验证提出的多机器人系统
的有效
性, 计基 易燃 搜寻实验,
对 出的 算法 的 效性和 准确 性 行验 。
1
系统设计
计的基
线传感器 络的多机器人系
统结构 1所示。每个线传感器网络节点是以DSP TMS320F28335为控制核心的嗅觉机器 人。
机器人上安装
传感器、风速传感器、
温度传感器及麦克风 对环境信息进行监测,经信号调理电路由DSP进行采集和处理,驱动机 并实现
机器人的导 。
机器人 装配
线传输模块与 机(PC机)构成的Sink节点进行信息交互,组
搜寻多机器人系统。
图1系统结构框图
1.1硬件设计
机器人硬件设计框图如图2所。由信号
处理与控制单元(TMS320F28335 )、无线收发模块、
阻传感器、外部SD卡、实 及移动小车等组
机器人系统的基础
部分。在虚线框1内的气
传感器和风速传感器实现 机器人对:浓
度、风速信息的采集;虚线框2内的点传感器用于
发报警器;在虚线框3内的麦克风
实现机器人对声 信 采
。
图2嗅觉机器人硬件设计框图
1.1.1处理与控制单元
计 对多种传感器数 的实 采 和
、 声
搜 算 法 的 实 现, 用 TI
的TMS320F28335浮点DSP控制器。该DSP :
精度
高, 低, ,性高,外 度高,数
及程 大,A/D. 精确快速等特点。1.1.21 传感器
计采用日本Figao公司TGS2620型金属
氧
导
传感器,
对精和有机汽灵敏度较高的特点,
应用
精、有机
1134
传感技术学报www. chinatransducers. com
第31卷
汽等可燃性 ,由
检测。当检测 燃风速传感器基于热 150
风
移原理,加热 阻会带走热量,
阻到约阻温
度越高,传感器的电导率就越高。因
度的变 行测
传感器(Z,Z2,Z)
传感器
传机
度差。
此,可采用简单测 路对
。传感器部分采用3个 安装在彼此
实现对 器人上安装的
度的变化,阻 变化,实现了对风速的测量。
机器人装配2个风速传感器对风速进行采集 $
?中K风速的
X
K
120。的等长臂上,组 度的采集,获
3所
。图4所
所示%, 用挡板隔开,进而
确定风向。
感器信号调理电路
传感器的分布图。
图4气体传感器和风速传感器分布图
\"V
V
磁阻传感器采用 计■
阻传感器(厘'%】】,它
图3 体传感器信号调理电路
1.3风速传感器
风速测量电路中采用铂电阻PT60作为风速测量 传感器,使用45 mA ~ 50 m
A
;器,可测 向、纵向两个方向的磁感应是 传感
度,两路磁感应强度信号,可用机器人 测
平 的方向,确
机器人的航向角。\\所。
该阻传感丨器的信号调理电路
的 工作
电流,PT1000用于桥路的温度补偿,减小测量误差。
+5 V
+5V
OFFSET-(A)OFFSET+(A)16X
OUT+(A) 2OUT+(A)S/R-(A)15
X-
VBRIDGE(A)
OUT-(A) 4OUT-⑷OUT-(B)
OUT-(B)AGND'
GND(A)
S/R+(B)S/R+(B)
hmcl02 2
S/R+(A)14 S/R+(A)GND(B)13OUT+(B)12 OUT-(B)OFFSET+(B)S/R-(B)
AGND
S/R+(A)
C310.1 I.iF
S/R+(B)
Q
VBRIDGE(B)OFFSET-(B)
X
0.1 !■i¥
图5磁阻传感器信号调理电路
1.1.5音频采集单元
计采用4个麦克风组成阵列实现声音采集
与声 ,麦克风 机器人上的 B
所示。音频放大电路采用MAXA&U专用音频放大 器实现对麦克风输出信号的放大, 7所。音频 路采用TL6320AIC23B '频编码器实现,理
& 所 。
图E麦克风阵列在机器人上的分布
第7期陈寅生,赵文杰等:危险气体泄漏源搜寻多机器人系统的设计与实现
z
1135
\\
._______11
2
1.1.6无线传输模块
•
audio
MAX981 2
SHDN
IN
6__II_
C3847 pFCs4
0.1 pF
机器人上都装配 线通信模块并与
机Sink 点一同组 线传感器网络进行信息交互。用
机对
机器人进行控
制, 机器人的信息 反 机。本计采用Chipcon 的CC2430 线信模,是种以经典8051微理器为内核的无线单片 机,
Cn
〇.l^F+3.3V
I
II
*16
个
AGND2<^-RLINEINB
0.1 pF
GND
BIASVCC
2.2 kfi+3.3 VA2
0.1 MF
*
17音频放大电路图
AGND2
9所示。
C88
BCLKB
DINBLRCINBDOUBLRCOUTB
*
Rfi\\
I 1BVDD
CLKOUTBCLK
n33Q 4
一 4
DGND28 I
27 1I +3.3 VDVDD
XTO
24SCLA
io kn
*12
丁o.i
-1—C72 Z1+
10 垆
AGND2
AGND2
AGND2
图8音频编码电路
1.1.7电机驱动模块
计中机器人的运动利用T)
L$A!D
的
驱动芯片对两个
。
速电机进行驱动,电
机驱动电路 10所
1C 件设计1.2.1
图11所
图D无线传输模块
VCC
VCC
搜寻DSP软件设计
机器人
搜寻DSP软件流程图。
1.2.2听觉搜寻DSP软件设计
图12所
机器人听觉搜寻DSP软件流程图。
U2g
IN12
Q:
lkQ
47 kQ
及19
10
15IN2
IN3IN4EN
SST3904
iii
4GNDi
VCc V
\\cUTolUTror2UTo3UTror4
16
8
VCC2
14
及20
IN34
lkQ
q
,SST390 4
2
12II
L293D
GND2
v
图10电机驱动电路
1136
传感:技术学报www. chinatransducers. com
第31卷
图11嗅觉搜寻DSP软件流程图
图12听觉搜寻DSP软件流程图
1.2.3
线通信
件设计
实现了机器人与上位机(Sink节
线传感器网络,传信息
度,搜
2
无线通信
气源搜寻算法
点)的无线数据传输,构
2.1半随机移动法
机移动法类似
用单独一个 测,
的化学趋向性,仅采
度检
度增大的方向
的浓度大大大降低低。半,
用的存
& ,降
低
传感器进行不同点的
包括移动机器人的航向角,气体传感器和风速传感器 采集的数据,声源方向角,无线络信 等,同 控制。无线信
机利用无线传感器网络对机器人进行
件流程如图D所示。
逻辑判断,使机器人总向
判 续 度,但搜 高
与
运动。虽然采取类似 器人每走 ,决 硬件电路的
的化学趋向性的算法(机
1系统初始化1
--------------1
看门狗复位
口接收^
或者调转方向%,
机移动法
修改目标节点地址1
1无线网络发送1
1帧数据校验1
很小,
法原理如下所述:
!个点的Z=%。算
1接受信号强度1
士
1
串口发送1
时器中
①无风条件下
首先让机器人随机前行,测得点处的Z=%值(Z ,Z 纯 的
点Z/Z
一
条直线上!个
|发送信号强度帧|
传感器的阻
传感器阻值%。然
车的移动方
图13无线通信单元软件流程图
的同确定下
第7期陈寅生,赵文杰等:危险气体泄漏源搜寻多机器人系统的设计与实现
1137
向。机器人的运动方式只有4种,前进,后转180°, 左转和右转。设三点浓度分别为$,3,<
算法表述如下: