首先,先来看一下这个模块的基本功能和原理。 HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能,测距精度可达高到3mm;模块包括超声波发射器、接收器与控制电路。像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。 注意是5v输入,但是我用stm32 的3.3v输入也是没有问题的。 8 D, m+ D( q: Q8 Q
, o5 t4 m8 W" J3 n& l* V, s
二.工作原理 1.给超声波模块接入电源和地。6 z: K/ G! i! z S/ R, F, W
2.给脉冲触发引脚(trig)输入一个长为20us的高电平方波 3.输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;(此时应该启动定时器计时)$ U/ e7 t5 n6 ]1 k5 _( ? Y! ~# n: {
4.当超声波返回被模块接收到时,回波引 脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长。
8 f: s! @5 u+ x7 M: j0 ` 5.根据声音在空气中的速度为344米/秒,即可计算出所测的距离。 要学习和应用传感器,学会看懂传感器的时序图是很关键的,所以我们来看一下HC-SR04的时序触发图。
# p7 w! {* v1 x( `) Z" f 我们来分析一下这个时序图,先由触发信号启动HC-RS04测距模块,也就是说,主机要先发送至少10us的高电平,触发HC-RS04,模块内部发出信号是传感器自动回应的,我们不用去管它。输出回响信号是我们需要关注的。信号输出的高电平就是超声波发出到重新返回接收所用的时间。用定时器,可以把这段时间记录下来,算出距离,别忘了结果要除于2,因为总时间是发送和接收的时间总和。 下面是亲测可用的驱动程序。 芯片型号为stm32f103zet6,超声波测距后通过串口打印到电脑上面。 驱动和测距; - //超声波测距
9 u; k5 e( J, w @( Z - / z; K2 g+ o$ c0 L$ }- x c
- #include "hcsr04.h"
. a! s0 c2 y& t" E" a: \- g9 B* L+ L -
) G# [# U: `0 Y1 M - #define HCSR04_PORT GPIOB
7 e/ q$ _, k, o9 b - #define HCSR04_CLK RCC_APB2Periph_GPIOB
, q( [3 j! Z8 Y% u. J6 b( d - #define HCSR04_TRIG GPIO_Pin_5
3 A0 U% X' \2 k# V - #define HCSR04_ECHO GPIO_Pin_63 x1 @: n2 `- o3 v7 ~
' m) A# d: ]& b& s, k/ }; j- #define TRIG_Send PBout(5) ! B( w% z+ t6 ~% z! F
- #define ECHO_Reci PBin(6)
6 |* p% v' o; b2 ] - 0 M _& b3 U! B& n- ^; B; s0 ^
- u16 msHcCount = 0;//ms计数2 R5 v0 j$ y, p' K
4 F& s' `( n# W/ k; W+ x- void Hcsr04Init()0 K9 |' U2 T6 l: M2 P3 O$ _
- { ( R; O8 E& m- G2 E% r
- TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; //生成用于定时器设置的结构体# C+ r( p8 z" r5 R& Z
- GPIO_InitTypeDef GPIO_InitStructure;
2 l X; R' [3 I - RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);
) w! d1 [1 U) J2 o -
3 H9 S8 P0 }1 q% h( Y" l - //IO初始化
- w$ H7 n( ^; A: I5 g) c - GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG; //发送电平引脚
% o. O2 v1 D! L6 ]3 ] - GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;7 c* }% a& f$ Q* H# v1 Z, W; n
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出6 D6 I# V* Q* M/ C8 l% q: [
- GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);
; F* `7 f7 u) s - GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);+ x3 {4 `8 c# D% p, ?. X
-
# \$ ?; k4 G6 P% U1 k - GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO; //返回电平引脚; l6 F2 e: I. V3 G$ x- B. [( p
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
& B6 ] ?- i: C, L! A; P - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);
. K+ g* f$ [. p9 w - GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO);
' z( `* R7 Z/ B7 J& L5 G - * N. e$ d) Y" {( y9 r( ]
- //定时器初始化 使用基本定时器TIM6
2 d$ P3 W O7 @7 n6 I - RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //使能对应RCC时钟
( |7 i! P' x V4 l3 [ W% b0 X - //配置定时器基础结构体
; t$ P* U1 X3 P - TIM_DeInit(TIM2);* I7 d D* ^% x
- TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值 计数到1000为1ms
: d6 y- ~& B& {# ]2 k* y2 H - TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值 1M的计数频率 1US计数9 M% n/ x7 G) _* ~0 E8 W0 o
- TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频- R9 g' f" X6 F j
- TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式$ W' t1 f0 l/ x }+ F
- TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
$ v T$ A9 Z! n: | - ) ? D# c1 R5 W4 }1 e( J5 A3 B- O
- TIM_ClearFlag(TIM6, TIM_FLAG_Update); //清除更新中断,免得一打开中断立即产生中断8 P* Z0 S( W( [* N: b0 `- ^
- TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); //打开定时器更新中断+ ^ t0 y. L# k) P& F/ L
- hcsr04_NVIC();0 W6 T' l$ Q% w
- TIM_Cmd(TIM6,DISABLE); . t9 T1 Y e# H
- }$ b( @' x' J0 M
- ; D% ~: G F o& P
- ! }) S' q1 d1 u1 J! m3 m% N4 q
- //tips:static函数的作用域仅限于定义它的源文件内,所以不需要在头文件里声明
& D1 O. |# ^& M' ~3 `" R - static void OpenTimerForHc() //打开定时器7 T/ e' R: v# F& u
- {0 P) F1 s0 ^" n+ F8 j. F
- TIM_SetCounter(TIM6,0);//清除计数. V. C( I% p$ z$ {
- msHcCount = 0;% {% x h( @8 @7 O& v: q& j
- TIM_Cmd(TIM6, ENABLE); //使能TIMx外设
, S. ]% u! j& [5 t - }
4 L1 Z2 H5 F' ^( ]( O9 H -
& @( B0 T: L" M - static void CloseTimerForHc() //关闭定时器
7 S- ^2 U. b* N - { U0 E5 R9 [& b5 g q6 N
- TIM_Cmd(TIM6, DISABLE); //使能TIMx外设; N$ ~ S: {0 V0 u
- }5 A2 b) E3 z1 R2 l$ Z# `4 `
- " W9 t9 l+ v( j5 a# A
- 4 n" |) b' p& G( K |% r
- //NVIC配置- I# k" x: Q/ v
- void hcsr04_NVIC() B* i2 n- u! @: V5 R
- { K5 C. g9 G+ P: a; T7 l& g) z3 `
- NVIC_InitTypeDef NVIC_InitStructure;
/ c+ Q/ a3 [; h( ~1 h2 C" \3 N K - NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
2 r- x; \( M/ f - : b# X1 P0 j; `$ C" W/ S
- NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn; //选择串口1中断
/ d3 E! q( e/ G# i1 g5 x - NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占式中断优先级设置为1
! U) P: _% G f - NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //响应式中断优先级设置为1, U( m; r4 N* {
- NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能中断* m1 K" q& x. S1 @8 f5 {* h# @3 c4 ?4 I
- NVIC_Init(&NVIC_InitStructure);1 s* A" D" e, `% M+ Z
- }% C3 @& m O1 W- R/ Z$ s8 P
- , V( e$ ~+ [- p: S7 {" o3 b
- ' C* x" L g4 Q5 c; s7 P& q& T
- //定时器6中断服务程序
9 r* J0 }! ~, }) _ - void TIM6_IRQHandler(void) //TIM3中断
6 Y3 X1 O( Q$ ~ K5 |6 p - {7 M: E5 n6 n1 j I( f. Z
- if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET) //检查TIM3更新中断发生与否
, X w) \! w6 b0 p$ N+ O2 V& V - {
- y6 k9 @7 u/ T. Y2 R% v4 y - TIM_ClearITPendingBit(TIM6, TIM_IT_Update ); //清除TIMx更新中断标志
& X4 A/ D0 I& D: k, R8 f9 e - msHcCount++;# J1 A* b) B0 j
- }
# ]) x: Y$ J1 D( U - }
1 r: h: v" `5 T* O# z3 i- k -
! n+ D, G: w2 q2 K - % L8 [& I& }8 K1 e/ z
- //获取定时器时间. i9 ^: [, A3 B5 T
- u32 GetEchoTimer(void)4 A. s4 l0 D6 w& P4 @; t4 j9 ^ j
- {
$ o' Y* K8 k3 Y) e9 E) F - u32 t = 0;1 q8 l% ?# U9 p5 W0 ]5 z
- t = msHcCount*1000;//得到MS
+ q6 w4 {1 E# ^/ a - t += TIM_GetCounter(TIM6);//得到US; R: S; M" w4 e- f1 {5 K) y
- TIM6->CNT = 0; //将TIM2计数寄存器的计数值清零7 h6 C1 Z {8 I; ^% K( n! E2 H
- Delay_Ms(50);7 s9 y, P5 f, c4 P7 j+ Z/ A. J) \) R9 h
- return t;
4 y4 v. |4 ?5 L# q `2 r- o9 R - }" f; r; ~% `3 d+ a8 j$ F
-
5 c& N/ N% h5 B
& [: }5 R( A( A% p$ W- //一次获取超声波测距数据 两次测距之间需要相隔一段时间,隔断回响信号
- `* {& n* N+ n [8 R - //为了消除余震的影响,取五次数据的平均值进行加权滤波。0 ^# r& y% _* G% |, ?1 B0 G$ q
- float Hcsr04GetLength(void )
7 G& ~, ?/ i8 o3 R8 d - {
$ H* m# }# t+ w o$ n/ y+ }* F# i4 Z - u32 t = 0;
( c" d, K5 H& ~. P f8 E3 ^ - int i = 0;. `) }$ A2 u3 M" d
- float lengthTemp = 0;
. O8 g4 E3 r2 K4 b5 F, ?5 f - float sum = 0;
9 `' I6 s2 i5 ?: o% a' {8 v& u - while(i!=5)4 V6 ~7 g3 y; b3 b" S
- {
( z) q8 ?( s5 @. o+ O - TRIG_Send = 1; //发送口高电平输出* o: R% V$ v, r6 l$ j
- Delay_Us(20);! `* u' h# C/ ~( P8 j7 l
- TRIG_Send = 0;
7 h, w0 H, i# e) w# @, p - while(ECHO_Reci == 0); //等待接收口高电平输出. w I( n. m- r4 A) Z! U
- OpenTimerForHc(); //打开定时器8 O! U3 n$ [# D$ u- N! t
- i = i + 1;
# R. F. g$ x) i* I d5 z - while(ECHO_Reci == 1);3 V6 D% {1 W/ x' G; I5 N
- CloseTimerForHc(); //关闭定时器
5 w9 j* D6 [: O - t = GetEchoTimer(); //获取时间,分辨率为1US5 _6 e) A: x0 u0 m5 p# F3 I. ~ W
- lengthTemp = ((float)t/58.0);//cm7 C/ R( M, D% f! a# \
- sum = lengthTemp + sum ;
3 O, j4 u7 N7 a9 D) s8 n - ' R; R6 K. v3 ?9 s2 w' @
- }' K* Q! u9 x. F3 C6 x4 u. o
- lengthTemp = sum/5.0;& D7 h- j Q, W1 ]9 l' [7 e
- return lengthTemp;
2 I/ _) c% ^, x! ?' L5 y& j3 H8 k8 F- p - }
$ w4 M' Y- @" E# z; M h6 @# O - - q T8 V F4 K1 v8 ?) S
% a- i: \% i4 |4 R; b- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::
0 S. s& _- V: n$ ?5 ~ - ** 函数名称: Delay_Ms_Ms
4 D- f& j* x% J, Y. p& R) f - ** 功能描述: 延时1MS (可通过仿真来判断他的准确度) ' ~' ~7 V M' z/ _# C% ~
- ** 参数描述:time (ms) 注意time<65535. P/ ~& S9 b! G W, w
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
! F \* |. C/ G5 G: v2 D; H - void Delay_Ms(uint16_t time) //延时函数: X" ^8 n3 d2 v6 y. `
- {
1 T N5 e; t1 a2 p$ J% g - uint16_t i,j;
' C. k9 [* i* L! I - for(i=0;i<time;i++)
+ [$ ^5 Y1 E( ^% Q W; L - for(j=0;j<10260;j++);
( l& y1 W3 q- }. s, d5 H - }( U0 J, W i1 o9 o, C+ [* U
- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::
, H6 h1 _. p ~; S& | - ** 函数名称: Delay_Ms_Us
: B0 o: o( A2 g0 B0 D3 M - ** 功能描述: 延时1us (可通过仿真来判断他的准确度)7 d/ ~5 s7 O7 p E) }
- ** 参数描述:time (us) 注意time<65535
9 C- {6 b" o. `/ {9 M7 T. T - :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
* L& T8 P! d4 F - void Delay_Us(uint16_t time) //延时函数! e1 P# S P; i' I9 Z X
- {
1 r6 h* O( h1 C- e3 z8 @* ^ - uint16_t i,j;
6 Q& X7 {9 h! D3 q- z0 O+ H - for(i=0;i<time;i++)' C f9 y b# |! z( {5 z
- for(j=0;j<9;j++);
' I7 V/ N1 S |8 i [1 H/ ] - }
复制代码
' L. Z0 s; F" d" B/ _6 V- t; {但是关于USART的函数我就不往上写了,这个简单的串口打印大家应该都会写。下面简单贴一下我的主函数吧。 - /*8 T( G5 H4 o6 ]' O9 v, V, S
- 教训:实验前一定要检查引脚连接是否正确,万不可搞错,不然又要烧坏芯片!!!!0 {% w5 f0 B# b. [; H0 l9 V1 l
; K. v7 i$ B- }4 P3 ^% c- */
7 S$ V, k4 j0 P, M8 d - $ [* y7 R+ u( k; L
- #include "hcsr04.h"9 w! D0 K8 Z, w, m& f. {
- #include "chao_usart.h"
7 A5 A( i$ [2 e# I! _4 S' J: u' N% J - * G- e7 @* n& a( |/ ?3 n
- int main()
9 H3 v: l) T1 \; u* P' ]/ I3 p - {
( Y! {6 \( M! Q$ L+ o$ ] - % q# z! `& i: F
- float length;
% u6 _3 [( J" C( b" D0 @- e - f: Y: j7 L# T5 Z* S
- GPIO_cfg();
9 ~. s; i! W4 H" ~( W1 I - NVIC_cfg();) P0 T& i/ ], r8 J+ l6 C
- USART_cfg();
2 j& a$ E" |/ c3 C$ S8 L - printf("串口初始化成功!\n");8 F& X/ `. s$ L2 i
- , ]3 [- r' B' P$ }
- Hcsr04Init();
- h0 h: p- H1 Z& K - printf("超声波初始化成功!\n");//测试程序是否卡在下面两句上面) q; A# T- ]' u
# T! _; {. s% u( {0 _8 V: `- length = Hcsr04GetLength();( j! d, z/ J, ^8 y6 M
- printf("距离为:%.3f\n",length);
* }- x+ N) n; o/ i) f - : v1 Q# h2 F0 y( X F6 f
-
4 y( L7 s0 w9 v( o3 m# V* P1 h, E - }
复制代码
( b' s$ i9 \" J B/ z4 o, t6 b6 ]- E# d4 E8 D9 T# s5 S
实验结果:
/ r. t& s" H. l8 G9 i5 _% p
+ H: q$ \ s& K4 G) \9 D3 f
% N" G4 m7 z. q" Y/ _; |好了,其实这个模块很简单,但是要是把他用的很好的话还是比较困难的,比如用超声波做一个四轴定高的程序,还是有一定的挑战性的。 写这篇博客的目的不仅仅是介绍这个模块的使用,其实这种使用介绍网上一搜一大把,我只是想纪录一下,我在做这个模块的时候遇到的一些其他的问题。 其中有一个小插曲,就是当吧写好的程序烧进去之后,运行时总是出现每次返回一个同样的比正常值小的多的数据,比如说0.034cm,这明显是一个错误的数据,但是刚开始的时候,不知道为什么 总是这样,多次复位从新上电总是这一个数据。让我很是苦恼。但是幸运的是,在这样的情况中间,他又会有时出现一两个正常的的数据,让你有点摸不着头脑。 上网查了一下才慢慢明白,这种现象叫做“余震”,网上关于余震的解释大致有三种: 1、探头的余震。即使是分体式的,发射头工作完后还会继续震一会,这是物理效应,也就是余震。这个余震信号也会向外传播。如果你的设计是发射完毕后立刻切换为接收状态(无盲区),那么这个余震波会通过壳体和周围的空气,直接到达接收头、干扰了检测(注:通常的测距设计里,发射头和接收头的距离很近,在这么短的距离里超声波的检测角度是很大的,可达180度)。
' U% Z, n; D0 S' @' n6 G3 X$ O f8 E( s 2、壳体的余震。就像敲钟一样,能量仍来自发射头。发射结束后,壳体的余震会直接传导到接收头,当然这个时间很短,但已形成了干扰。另外,在不同的环境温度下,壳体的硬度和外形会有所变化,其余震有时长、有时短、有时干扰大、有时干扰小,这是设计工业级产品时必须要考虑的问题。
* `5 L- S& r, b/ | 3、电路串扰。超声波发射时的瞬间电流很大,例如某种工业级连续测距产品瞬间电流会有15A,通常的产品也能达到1A,瞬间这么大的电流会对电源有一定影响,并干扰接收电路。通过改善电源设计可以缓解这种情况,但在低成本设计中很难根除。所以每次发射完毕,接收电路还需要一段时间稳定工作状态。在此期间,其输出的信号很难使用。 : s5 O/ Z$ E0 Q8 x
消除上述现象的方法之一就是在检测的时候多次循环检测,取平均值,也就是加权平均滤波,一个简单的滤波处理。就是下面这一段: - int i = 0;2 A0 C" v: d h6 w. k
- float lengthTemp = 0;0 @4 m3 e0 n2 |% A; H: C
- float sum = 0;
4 d( g( T. D4 [) M+ a - while(i!=5)& ~) X& N' k; Z
- {* `4 Y; |. G- p {8 B$ T
- TRIG_Send = 1; //发送口高电平输出
& Q5 C: t) A+ m4 c% }+ n- |6 b - Delay_Us(20);7 w n0 N! N9 B# \6 H: O2 M* i
- TRIG_Send = 0;
! @" c( y, x4 \, f6 M- u7 {% ]2 x - while(ECHO_Reci == 0); //等待接收口高电平输出
0 `# D5 x" D" ` - OpenTimerForHc(); //打开定时器
1 p, b" R3 m m2 h - i = i + 1;% o X2 \: R' z; @6 g; y% t4 B! a" U* h
- while(ECHO_Reci == 1);
5 |9 M2 i4 ?, Z% u* U5 }; [4 d - CloseTimerForHc(); //关闭定时器
a8 q& ?: Q& j5 p/ }2 o8 [ - t = GetEchoTimer(); //获取时间,分辨率为1US
$ c6 }* Z" d& _0 O - lengthTemp = ((float)t/58.0);//cm
3 [/ O; q1 \& _( N - sum = lengthTemp + sum ;+ z; d5 S$ \3 X$ o/ \6 b
- 3 i. l! X5 v9 o, a
- }, u" f# }( J2 _3 ]: H0 ^
- lengthTemp = sum/5.0;, m2 d( {: @. K0 |; k. a
- return lengthTemp;
复制代码 9 Y* R- Q `; A8 B
6 v" {% Z0 A$ z: b3 C
加了这个之后,基本上就没有出现余震现象了。 还有一点就是测试程序前一定要检查引脚有没有接错,不管多有把握,也要看一遍,不然很容易出大事的,一个芯片也许就因为你的大意给GG了。切记,这个应该也算我们这个行业的基本素养吧。
# R" T! `7 m/ ~$ r |