基于单接收头的超声波多目标测距

第20卷　第5期2007年5月

传感技术学报

CHIN ES E JOURNAL OF S ENSORS AND ACTUA TORS

Vol. 20　No. 5May. 2007

Multi 2G oal Measure B ased on Single U ltrasonic R eceiver 3

Z H A N G X i ao 2bi ng

1, 23

, S O N G A i 2g uo , T A N G Hong 2ru

22

1. Elect ricit y and Communication College of A nhui universit y of indust ry , M aanshan A nhui 243002, China; 2. Depart ment of I nst rument Science and Engineering of S out heast Universit y , N anj ing 210096, China

Abstract :A ult rasonic receiver is required to measure a few goals order to under t he dynamic condition. Firstly t he characteristic of ult rasonic t hen t he wave expression of receiving signal is deduced. a is adopted as t hreshold in calibrating system and a low t information. Finally a C8051F021chip is used to design receiver. Two distances are measured accurately when t he t f goals to t he receiver is more t han 30cm. K ey w ords :distances ;multi 2goal ;circuit design EEACC :7810

基于单接收头的超声波多目标测距

章小兵1,23, 宋爱国2, 唐鸿儒2

3

(1. 安徽工业大学电气信息学院, 安徽马鞍山243001;2. 东南大学仪器科学系, 南京210096)

摘　要:为了使超声波传感器能在动态环境下定位, 要求单超声波接收头能测量多个目标. 首先分析了超声波发射头产生的

超声波特点, 据此推导出接收信号的波形表达式. 其次根据接收信号特点, 系统标定时用接收信号包络峰值的0. 5倍作阈值, 而测量时用小阈值, 以防止距离信息丢失. 最后用C8051F021单片机设计了单接收头多目标测距系统. 在2目标与接收头距离之差大于30cm 以上时能较精确地测量出2个距离.

关键词:超声波; 测量距离; 多目标; 电路设计中图分类号:TP274.53　　

文献标识码:A　　文章编号:100421699(2007) 0521167204

　　超声波测距传感器以其测量精度高、响应快和价格低廉而广泛应用在工业现场测距、移动机器人导航和定位等场合[1～5]. 超声波测距传感器常用的方式是1个发射头对应1个接收头, 也有多个发射头对应1个接收头. 它们共同之处是:每个接收头只测量一个位置, 这个位置就是除盲区内因发射的超声波旁瓣引起的接收信号超声波包络峰值外, 第1个接收信号超声波包络峰值对应的距离. 在机器人自主导航避障时, 机器人只关心最近障碍物的距离, 是能够完成自主避障的. 但是在机器人定位时, 尤其在动态环境下,1个接收头同时测量多个距离, 能够更多地描述环境信息, 这对机器人用超声波定位具有重要意义[6].

1　超声波

1. 1　超声波测距原理

超声波测距原理比较简单, 一般是采用时差法. 即:通过检测发射的超声波与其遇到障碍物后产生回波之间的时间差Δt , 求出障碍物的距离d , 计算公Δt/2, 其中c =331. 4×+T 1/273≈式为:d =c

331. 4+0. 6T 1, c 为超声波波速, T 1为环境摄氏温

度.

1. 2　发射信号超声波包络

在发射头两端加40k HZ 的矩形脉冲电压, 压电晶体把电能转变成机械能, 带动其上振动板运动, 见图1. 振动板的固有频率是40k HZ , 由于共振, 振

基金项目:霍英东教育基金资助项目; 国家自然科学基金资助项目(60475034)

收稿日期:2006204217　　修改日期:2006205215

1168传　感　技　术　学　报

250μs 左右, 即9～12个T , T =25μs .

2007年

动板很快起振, 然后稳定, 脉冲电压撤销, 振动板作阻尼振荡衰减. 若振动板长时间工作在最大振幅状

态, 即振动板新增能量与其损耗能量相等, 这样产生的超声波能量大, 有利于提高信噪比, 但是接收信号超声波包络从起振到峰值的时间将变长(放大器增益小, 不出现削顶的情况下) , 不利于阈值选择, 误差变大, 也不利于第二个位置的测量, 另外盲区也会增大. 振动板振动时, 空气、压电晶体(起振时是激励) 等消耗振动板能量, 其中受空气阻力消耗的能量转变成发射超声波. 压电晶体激励撤销, 作阻尼呈指数关系衰减[7]. 弹簧振子, s ) 内是标准正弦波, n ≤N 时, 发射头振动板运动满足:

x =A (n ) sin ωt , 式中t ∈[(n -1) T , nT ], A (n )

(1) 是第n 个周期内的振幅.

2

E (n ) =kA (n ) , k 是常数, E (n ) 是第n 个周

2

(2) 期内振动板的机械能.

-2aT

) E (n ) , a 是一个与衰减有关E f (n ) =(1-e

的常系数, E f (n ) 第n 个周期内振动板损耗的机械能.

n

根据发射的超声波能量特点, 得出接收信号每个周期能量的表达式, 设每个周期内的正弦波是标准正弦波且发射头振动板尚未达稳定振动状态.

n

W R 1(n ) =k 4

i =1

∑A (i ) e

-a (n-i ) T

, (n ΦN ) , N 是发

(6) (7)

射头激励脉冲数.

e

-a (N ) T

-a (n-) T

R 2(=R ) +k 4(n -N ) A (N )

, (N ) a () N , a 一定的情况下, 每个反) 化后是相同的. 为了便于取阈值, 分析接收信号包络的特性与n 、N 的关系是必要的. 首先找出定值a , 方法是取N =5, a 值在一定范围内变化得到多幅仿真

图, 经比较a =5000/s 时得到的图2与图1接近. 根据得到的a 值可仿真N =12时的接收信号, 见图3

.

(3)

ΔE =E (n ) +n

i =1

∑E

f

(n ) , ΔE 是压电晶片每次

图2　接收信号仿真(N =5, a =5000/s )

(4) 施加的能量.

在n >N 时, 发射头振动板运动能量满足:E (n ) =e

-2aT (n-N )

E (N ) .

2　阈值和分辨率

阈值的选取, 决定本测距系统的测量精度. 由于回波的能量大小受入射角、反射面大小、形状和材质、空气的湿度和温度等因素决定, 为了较精确地测量文献[6]中机器人与墙壁之间的距离, 下面只针对超声波垂直入射墙壁, 接受信号的大小进行分析.

在测量时, 一旦有干扰物挡住超声波到墙壁的行进路径, 则墙壁返回的信号将减弱, 过高的阈值可能测不到墙壁回波信号, 动态阈值因无规律可循而无法使用, 故此阈值采用小固定值, 因接收信号中的噪声峰值较稳定, 固定阈值取3～5倍噪声峰值. 由于墙壁回波信号不确定地高低变化, 在标定测量参数时, 用示波器采集信号, 以接收信号包络峰值的0. 5倍处(即图2中n =4或5处的时间) 作为距离信息. 这样处理的目的是:即使接收信号过强或过

1. 3　接收信号超声波包络

发射头产生的超声波遇到不同介质就会产生回波, 接收头把回波转变成电能, 产生接收信号. 现分析超声波垂直入射到墙壁面时的接收信号, 接收信号超声波包络由起振阶段和衰减阶段两部分组成, 如图1. 接收信号与回波超声包络的各正弦波幅值关系是:

(5) W R =W E cho H

式中W R 是接收信号包络峰值, W E cho 是回波包络峰值, H 是回波的单位冲击响应

.

图1　实际接收信号(N =5)

弱, 测距误差始终在3～5cm 以内. 当N 过大时, 盲区会增大同时测量精度也会下降, 见图3.

多目标测量要能区分出两个不同目标. 由于阈值取得小, 则系统的分辨能力很差, 从图2上可看出

从图1中可看出, 接受信号包络从起振到峰值的时间要小于从峰值衰减至噪声幅值的时间. 实际总长度接近1. 5～2ms , 而从起振到包络峰值只需

第5期章小兵, 宋爱国等:基于单接收头的超声波多目标测距1169

4　系统软件

系统软件基本构架如下:

void main ()

{config (); EA =1; While (1) {}; }void time0_inter()interrupt 1{}void time1_inter()interrupt 3void ()void 16{}()interrupt 9{}

图3　接收信号仿真(N =12, a =5000/s )

接收信号经1. 5ms 后正弦幅值是包络峰值的0. 倍. 图2得到, 基本固定, , 一般从起振经1. 2ms 后都会降到阈值以下. 在测量墙壁距离时, 只要干扰物与墙壁保持30cm 以上距离则墙壁距离能较精确获得.

初始化程序config ():I/O 交叉开关配置; 使用外部时钟, 指定系统时钟;time 0～4中断使能, 其中time 0溢出中断发生, 产生40k Hz 方波信号输出; PL A 中断开启.

中断函数time0_inter():产生5个40k Hz 方波信号输出后关闭time0中断, TF0=0; PL A 溢出、边缘捕捉中断开启.

中断函数PCA_inter():若是溢出中断发生(30ms ) , 则关闭PCA_inter()中断,CF =0, 开启time0中断; 若是CCFn =1, 则记下定时器时间(与初值相减后代入标定式得距离) , 给定time n 计时初值并启动time n 溢出中断(2ms ) , 关闭CCFn 中断, CCFn =0.

3　系统硬件

C8051系列单片机具有丰富的模拟、数字外设

和多种总线接口, 支持在线编程, 是很多测控系统的首选[829]. 系统硬件框图如图4,C8051F021有5个定时器,5个PCA 通道, 测4个方向的超声波传感器发射头可共用1个40k Hz 方波信号, 实行同步发射;4个接收头可接入PCA 的4个通道. 信号放大电路的放大倍数在800左右, 即使接收信号经过带通滤波器, 噪声峰值也达30

mv.

中断函数time1_inter() ～time4_inter() :当time n 中断发生则开启CCFn 中断, 关闭time n 中断, TFn =0.

5　结语

本文对单个接收头在一次采样时间(30ms ) 内测量多个目标进行了尝试, 仿真并分析了接收信号波形, 用0. 5倍包络峰值标定而用小阈值测量, 在2个目标与接收头距离之差大于30cm 以上时能较精确测量出2个目标, 误差不超过2cm.

由于一次能在同一时刻测多个距离, 增大了超声波传感器捕获的信息量, 移动机器人装配了该传感器能在人员不是密集的动态环境下根据4面墙壁定位. 参考文献:

[1]　赵珂, 向瑛, 王忠等. 高准确度超声波测距仪的研制[J].传

图4　

单接收头多目标测量电路框图

感器技术, 2003, 22(2) :55257.

[2]　戴曰章, 吴志勇. 基于A T89C51单片机的超声波测距系统设

计[J].计量与测试技术,2005, 32(2) :17219.

[3]　沈进棋, 诸静, 阮锋. 移动机器人多路超声波数据采集系统的

图5　用示波器标定系统(只有一个发射头和一个接收头)

研究与实现[J].电子技术,2003, (11) :629.

[4]　汪云涛, 鲍青山, 王树国等. 超声探测系统在移动式智能机器

1170传　感　技　术　学　报2007年

人中的应用[J].哈尔滨工业大学学报,1998,30(1) :20223.

[5]　贾莉娜. 高精度的超声波测距系统在移动机器人导航方面的

[8]　童长飞. C8051F 系列单片机开发与C 语言编程[M ].北京:

北京航空航天大学出版社,2005.

[9]　Cygnal Intergrated Product s , Inc. 潘琢金, 孙德龙, 夏秀峰.

C8051F 单片机应用解析[M ].北京:北京航空航天大学出版

应用[J].计量与测试技术,2004, (9) :23225.

[6]　章小兵, 宋爱国, 唐鸿儒. 一种基于多超声波传感器定位的新

方法[J].制造业自动化,2006,28(1) :29232.

[7]　许肖梅. 声学基础[M ].北京:科学出版社,2003.

社

,2002.

章小兵(19722) , 男, 博士生, 副教授, 研究方向为移动机器人技术及电子电路设计,xyzxb @ahut. edu. cn.

第20卷　第5期2007年5月

传感技术学报

CHIN ES E JOURNAL OF S ENSORS AND ACTUA TORS

Vol. 20　No. 5May. 2007

Multi 2G oal Measure B ased on Single U ltrasonic R eceiver 3

Z H A N G X i ao 2bi ng

1, 23

, S O N G A i 2g uo , T A N G Hong 2ru

22

1. Elect ricit y and Communication College of A nhui universit y of indust ry , M aanshan A nhui 243002, China; 2. Depart ment of I nst rument Science and Engineering of S out heast Universit y , N anj ing 210096, China

Abstract :A ult rasonic receiver is required to measure a few goals order to under t he dynamic condition. Firstly t he characteristic of ult rasonic t hen t he wave expression of receiving signal is deduced. a is adopted as t hreshold in calibrating system and a low t information. Finally a C8051F021chip is used to design receiver. Two distances are measured accurately when t he t f goals to t he receiver is more t han 30cm. K ey w ords :distances ;multi 2goal ;circuit design EEACC :7810

基于单接收头的超声波多目标测距

章小兵1,23, 宋爱国2, 唐鸿儒2

3

(1. 安徽工业大学电气信息学院, 安徽马鞍山243001;2. 东南大学仪器科学系, 南京210096)

摘　要:为了使超声波传感器能在动态环境下定位, 要求单超声波接收头能测量多个目标. 首先分析了超声波发射头产生的

超声波特点, 据此推导出接收信号的波形表达式. 其次根据接收信号特点, 系统标定时用接收信号包络峰值的0. 5倍作阈值, 而测量时用小阈值, 以防止距离信息丢失. 最后用C8051F021单片机设计了单接收头多目标测距系统. 在2目标与接收头距离之差大于30cm 以上时能较精确地测量出2个距离.

关键词:超声波; 测量距离; 多目标; 电路设计中图分类号:TP274.53　　

文献标识码:A　　文章编号:100421699(2007) 0521167204

　　超声波测距传感器以其测量精度高、响应快和价格低廉而广泛应用在工业现场测距、移动机器人导航和定位等场合[1～5]. 超声波测距传感器常用的方式是1个发射头对应1个接收头, 也有多个发射头对应1个接收头. 它们共同之处是:每个接收头只测量一个位置, 这个位置就是除盲区内因发射的超声波旁瓣引起的接收信号超声波包络峰值外, 第1个接收信号超声波包络峰值对应的距离. 在机器人自主导航避障时, 机器人只关心最近障碍物的距离, 是能够完成自主避障的. 但是在机器人定位时, 尤其在动态环境下,1个接收头同时测量多个距离, 能够更多地描述环境信息, 这对机器人用超声波定位具有重要意义[6].

1　超声波

1. 1　超声波测距原理

超声波测距原理比较简单, 一般是采用时差法. 即:通过检测发射的超声波与其遇到障碍物后产生回波之间的时间差Δt , 求出障碍物的距离d , 计算公Δt/2, 其中c =331. 4×+T 1/273≈式为:d =c

331. 4+0. 6T 1, c 为超声波波速, T 1为环境摄氏温

度.

1. 2　发射信号超声波包络

在发射头两端加40k HZ 的矩形脉冲电压, 压电晶体把电能转变成机械能, 带动其上振动板运动, 见图1. 振动板的固有频率是40k HZ , 由于共振, 振

基金项目:霍英东教育基金资助项目; 国家自然科学基金资助项目(60475034)

收稿日期:2006204217　　修改日期:2006205215

1168传　感　技　术　学　报

250μs 左右, 即9～12个T , T =25μs .

2007年

动板很快起振, 然后稳定, 脉冲电压撤销, 振动板作阻尼振荡衰减. 若振动板长时间工作在最大振幅状

态, 即振动板新增能量与其损耗能量相等, 这样产生的超声波能量大, 有利于提高信噪比, 但是接收信号超声波包络从起振到峰值的时间将变长(放大器增益小, 不出现削顶的情况下) , 不利于阈值选择, 误差变大, 也不利于第二个位置的测量, 另外盲区也会增大. 振动板振动时, 空气、压电晶体(起振时是激励) 等消耗振动板能量, 其中受空气阻力消耗的能量转变成发射超声波. 压电晶体激励撤销, 作阻尼呈指数关系衰减[7]. 弹簧振子, s ) 内是标准正弦波, n ≤N 时, 发射头振动板运动满足:

x =A (n ) sin ωt , 式中t ∈[(n -1) T , nT ], A (n )

(1) 是第n 个周期内的振幅.

2

E (n ) =kA (n ) , k 是常数, E (n ) 是第n 个周

2

(2) 期内振动板的机械能.

-2aT

) E (n ) , a 是一个与衰减有关E f (n ) =(1-e

的常系数, E f (n ) 第n 个周期内振动板损耗的机械能.

n

根据发射的超声波能量特点, 得出接收信号每个周期能量的表达式, 设每个周期内的正弦波是标准正弦波且发射头振动板尚未达稳定振动状态.

n

W R 1(n ) =k 4

i =1

∑A (i ) e

-a (n-i ) T

, (n ΦN ) , N 是发

(6) (7)

射头激励脉冲数.

e

-a (N ) T

-a (n-) T

R 2(=R ) +k 4(n -N ) A (N )

, (N ) a () N , a 一定的情况下, 每个反) 化后是相同的. 为了便于取阈值, 分析接收信号包络的特性与n 、N 的关系是必要的. 首先找出定值a , 方法是取N =5, a 值在一定范围内变化得到多幅仿真

图, 经比较a =5000/s 时得到的图2与图1接近. 根据得到的a 值可仿真N =12时的接收信号, 见图3

.

(3)

ΔE =E (n ) +n

i =1

∑E

f

(n ) , ΔE 是压电晶片每次

图2　接收信号仿真(N =5, a =5000/s )

(4) 施加的能量.

在n >N 时, 发射头振动板运动能量满足:E (n ) =e

-2aT (n-N )

E (N ) .

2　阈值和分辨率

阈值的选取, 决定本测距系统的测量精度. 由于回波的能量大小受入射角、反射面大小、形状和材质、空气的湿度和温度等因素决定, 为了较精确地测量文献[6]中机器人与墙壁之间的距离, 下面只针对超声波垂直入射墙壁, 接受信号的大小进行分析.

在测量时, 一旦有干扰物挡住超声波到墙壁的行进路径, 则墙壁返回的信号将减弱, 过高的阈值可能测不到墙壁回波信号, 动态阈值因无规律可循而无法使用, 故此阈值采用小固定值, 因接收信号中的噪声峰值较稳定, 固定阈值取3～5倍噪声峰值. 由于墙壁回波信号不确定地高低变化, 在标定测量参数时, 用示波器采集信号, 以接收信号包络峰值的0. 5倍处(即图2中n =4或5处的时间) 作为距离信息. 这样处理的目的是:即使接收信号过强或过

1. 3　接收信号超声波包络

发射头产生的超声波遇到不同介质就会产生回波, 接收头把回波转变成电能, 产生接收信号. 现分析超声波垂直入射到墙壁面时的接收信号, 接收信号超声波包络由起振阶段和衰减阶段两部分组成, 如图1. 接收信号与回波超声包络的各正弦波幅值关系是:

(5) W R =W E cho H

式中W R 是接收信号包络峰值, W E cho 是回波包络峰值, H 是回波的单位冲击响应

.

图1　实际接收信号(N =5)

弱, 测距误差始终在3～5cm 以内. 当N 过大时, 盲区会增大同时测量精度也会下降, 见图3.

多目标测量要能区分出两个不同目标. 由于阈值取得小, 则系统的分辨能力很差, 从图2上可看出

从图1中可看出, 接受信号包络从起振到峰值的时间要小于从峰值衰减至噪声幅值的时间. 实际总长度接近1. 5～2ms , 而从起振到包络峰值只需

第5期章小兵, 宋爱国等:基于单接收头的超声波多目标测距1169

4　系统软件

系统软件基本构架如下:

void main ()

{config (); EA =1; While (1) {}; }void time0_inter()interrupt 1{}void time1_inter()interrupt 3void ()void 16{}()interrupt 9{}

图3　接收信号仿真(N =12, a =5000/s )

接收信号经1. 5ms 后正弦幅值是包络峰值的0. 倍. 图2得到, 基本固定, , 一般从起振经1. 2ms 后都会降到阈值以下. 在测量墙壁距离时, 只要干扰物与墙壁保持30cm 以上距离则墙壁距离能较精确获得.

初始化程序config ():I/O 交叉开关配置; 使用外部时钟, 指定系统时钟;time 0～4中断使能, 其中time 0溢出中断发生, 产生40k Hz 方波信号输出; PL A 中断开启.

中断函数time0_inter():产生5个40k Hz 方波信号输出后关闭time0中断, TF0=0; PL A 溢出、边缘捕捉中断开启.

中断函数PCA_inter():若是溢出中断发生(30ms ) , 则关闭PCA_inter()中断,CF =0, 开启time0中断; 若是CCFn =1, 则记下定时器时间(与初值相减后代入标定式得距离) , 给定time n 计时初值并启动time n 溢出中断(2ms ) , 关闭CCFn 中断, CCFn =0.

3　系统硬件

C8051系列单片机具有丰富的模拟、数字外设

和多种总线接口, 支持在线编程, 是很多测控系统的首选[829]. 系统硬件框图如图4,C8051F021有5个定时器,5个PCA 通道, 测4个方向的超声波传感器发射头可共用1个40k Hz 方波信号, 实行同步发射;4个接收头可接入PCA 的4个通道. 信号放大电路的放大倍数在800左右, 即使接收信号经过带通滤波器, 噪声峰值也达30

mv.

中断函数time1_inter() ～time4_inter() :当time n 中断发生则开启CCFn 中断, 关闭time n 中断, TFn =0.

5　结语

本文对单个接收头在一次采样时间(30ms ) 内测量多个目标进行了尝试, 仿真并分析了接收信号波形, 用0. 5倍包络峰值标定而用小阈值测量, 在2个目标与接收头距离之差大于30cm 以上时能较精确测量出2个目标, 误差不超过2cm.

由于一次能在同一时刻测多个距离, 增大了超声波传感器捕获的信息量, 移动机器人装配了该传感器能在人员不是密集的动态环境下根据4面墙壁定位. 参考文献:

[1]　赵珂, 向瑛, 王忠等. 高准确度超声波测距仪的研制[J].传

图4　

单接收头多目标测量电路框图

感器技术, 2003, 22(2) :55257.

[2]　戴曰章, 吴志勇. 基于A T89C51单片机的超声波测距系统设

计[J].计量与测试技术,2005, 32(2) :17219.

[3]　沈进棋, 诸静, 阮锋. 移动机器人多路超声波数据采集系统的

图5　用示波器标定系统(只有一个发射头和一个接收头)

研究与实现[J].电子技术,2003, (11) :629.

[4]　汪云涛, 鲍青山, 王树国等. 超声探测系统在移动式智能机器

1170传　感　技　术　学　报2007年

人中的应用[J].哈尔滨工业大学学报,1998,30(1) :20223.

[5]　贾莉娜. 高精度的超声波测距系统在移动机器人导航方面的

[8]　童长飞. C8051F 系列单片机开发与C 语言编程[M ].北京:

北京航空航天大学出版社,2005.

[9]　Cygnal Intergrated Product s , Inc. 潘琢金, 孙德龙, 夏秀峰.

C8051F 单片机应用解析[M ].北京:北京航空航天大学出版

应用[J].计量与测试技术,2004, (9) :23225.

[6]　章小兵, 宋爱国, 唐鸿儒. 一种基于多超声波传感器定位的新

方法[J].制造业自动化,2006,28(1) :29232.

[7]　许肖梅. 声学基础[M ].北京:科学出版社,2003.

社

,2002.

章小兵(19722) , 男, 博士生, 副教授, 研究方向为移动机器人技术及电子电路设计,xyzxb @ahut. edu. cn.