|
首先,先来看一下这个模块的基本功能和原理。 HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能,测距精度可达高到3mm;模块包括超声波发射器、接收器与控制电路。像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。 注意是5v输入,但是我用stm32 的3.3v输入也是没有问题的。
# _' Z- y) d! J8 V0 R' a K, b
4 u( f' y* Q) ~: W h' K$ o
二.工作原理 1.给超声波模块接入电源和地。
|( T4 y6 L: u) I0 S8 r( U4 } 2.给脉冲触发引脚(trig)输入一个长为20us的高电平方波 3.输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;(此时应该启动定时器计时)
4 T2 i$ n+ e3 l7 T) L1 J4 L 4.当超声波返回被模块接收到时,回波引 脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长。' w% }% F) N- W4 U
5.根据声音在空气中的速度为344米/秒,即可计算出所测的距离。 要学习和应用传感器,学会看懂传感器的时序图是很关键的,所以我们来看一下HC-SR04的时序触发图。 1 R1 J) G9 _% A4 y0 t) {; e% N
我们来分析一下这个时序图,先由触发信号启动HC-RS04测距模块,也就是说,主机要先发送至少10us的高电平,触发HC-RS04,模块内部发出信号是传感器自动回应的,我们不用去管它。输出回响信号是我们需要关注的。信号输出的高电平就是超声波发出到重新返回接收所用的时间。用定时器,可以把这段时间记录下来,算出距离,别忘了结果要除于2,因为总时间是发送和接收的时间总和。 下面是亲测可用的驱动程序。 芯片型号为stm32f103zet6,超声波测距后通过串口打印到电脑上面。 驱动和测距; - //超声波测距' m: V7 e& n; @: n1 d
- ! s0 o! R$ g# N& h! H9 z
- #include "hcsr04.h", C. a, G6 ^% z5 Z
- 3 H5 \- V! }- W$ D1 e! e
- #define HCSR04_PORT GPIOB$ U6 R; K B, X: x: `: y) Z
- #define HCSR04_CLK RCC_APB2Periph_GPIOB7 T3 }3 u: ~; U: ~: Z3 J6 ?, y( Z$ G# \
- #define HCSR04_TRIG GPIO_Pin_5' F& H- \4 X% ~
- #define HCSR04_ECHO GPIO_Pin_6! [0 z6 @8 q1 L! J
. ~- e1 i9 P/ j/ k. a6 z- #define TRIG_Send PBout(5) 7 z: H1 Q/ t/ } m
- #define ECHO_Reci PBin(6)' c3 s; j9 l5 }( s* U" |4 Y
" [, ~9 B% ]9 v# ^% H- u16 msHcCount = 0;//ms计数
* y2 B1 J- N) \" }6 r
2 {! b' J+ l; S5 g, y* y- void Hcsr04Init()
, h+ o+ E2 Q! ~8 W$ n8 J - {
& f* G6 h" Q+ K+ I* i8 {7 i - TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; //生成用于定时器设置的结构体' G1 T2 M* O7 j2 G+ @& w0 D6 { H
- GPIO_InitTypeDef GPIO_InitStructure;, N7 I$ b" M7 U* l3 q. {) r
- RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);, r7 z: j' A# U, k! ^
-
! E1 T# G( }7 U: Q3 S- a% @. ]+ r7 F2 b - //IO初始化
8 i+ w4 U1 S5 t1 J - GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG; //发送电平引脚) w0 k' @( r4 w* C
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
0 X! r- |, Y# M6 D! v - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出
4 P) S. u, R2 I - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);! u% D" w2 k3 S$ w
- GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);7 Y9 ^2 F+ R w3 d1 K
- / e9 I. h! e* e, d4 w
- GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO; //返回电平引脚6 `% ^- s6 Y" S+ M, v5 N
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入7 e8 a3 U1 s+ Z% u2 Q7 E' k
- GPIO_Init(HCSR04_PORT, &GPIO_InitStructure); ( X6 z: n6 t+ P# J
- GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO);
% O7 ?8 C: f3 N) Y4 R -
( W0 k: m9 H( g+ \5 _* A - //定时器初始化 使用基本定时器TIM6
( _( T. @- J! t0 ^9 O - RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //使能对应RCC时钟
$ i# E' J" ^/ z/ z- Z( u" a3 ` - //配置定时器基础结构体
7 _2 y8 |/ Q, t# H - TIM_DeInit(TIM2);& ^$ Y5 |( o- l
- TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值 计数到1000为1ms/ g4 @6 X- J" k5 m# t% d) U
- TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值 1M的计数频率 1US计数
- G" n) O' Q& E) w2 Q - TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频
. z0 |( w- D( S3 B' m - TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式% W" p: T G$ @6 Y7 e. J! z
- TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位 * F! }9 u1 |' t. c w
- 3 n: e( y! }1 s# r7 o
- TIM_ClearFlag(TIM6, TIM_FLAG_Update); //清除更新中断,免得一打开中断立即产生中断4 p4 t, T! \6 W% L" L
- TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); //打开定时器更新中断
' j6 O" L4 O8 w: O - hcsr04_NVIC();
8 c x7 _" D, _: V - TIM_Cmd(TIM6,DISABLE);
0 a! D- O; f, v& w - }
- G2 z2 H/ j$ R! ?, T. d - 4 K. t7 |; y8 x0 {3 Z/ s% ?4 n
- % b0 s0 a: _- b& ~- s D
- //tips:static函数的作用域仅限于定义它的源文件内,所以不需要在头文件里声明
: L* {, Z0 U5 |5 H. A - static void OpenTimerForHc() //打开定时器
: d7 S& j% w: Q4 {9 f N - {
0 i8 W: y$ U3 r- F! J4 V - TIM_SetCounter(TIM6,0);//清除计数
+ }- s- d' A+ D/ X - msHcCount = 0;' C* ~ o; d. x) q) u3 }) p5 \1 `9 S
- TIM_Cmd(TIM6, ENABLE); //使能TIMx外设5 \3 H9 {( c6 h6 u: e5 T' C9 z" h
- }- G1 o( j% D0 N0 C& U5 P5 r1 Z
-
/ ?0 P( Z4 q2 o( L1 h0 E, }: U7 c( L - static void CloseTimerForHc() //关闭定时器+ g' u# V4 W$ a* r n" @4 a2 |
- {1 l8 P' ~ T& K8 j
- TIM_Cmd(TIM6, DISABLE); //使能TIMx外设% d7 y: z+ h$ G; ^
- }2 j L, P* v7 g- @$ ]# ?
- 1 k) F- G0 r+ M) k6 j( H
-
9 [) Z5 E+ O# H0 F9 d& c# ~ - //NVIC配置) L1 _: V- U. b" n, ?5 G& d
- void hcsr04_NVIC()' r. B, Y4 J" z) k/ E
- {2 S" ~5 {& U% z( p! D
- NVIC_InitTypeDef NVIC_InitStructure;5 R) O: \6 b. S+ U# F% J( |) |" ^
- NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);- N1 V% J% W& p: k1 d$ e. `; c) U
-
" i/ m$ }8 j+ O& x: @4 Z% u' R - NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn; //选择串口1中断
! p% D( J$ A* V* F6 G8 | - NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占式中断优先级设置为1
. o8 `- V( i( D8 w+ O0 f - NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //响应式中断优先级设置为1( F$ d' L9 q; m) h8 Z2 N/ c
- NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能中断
, d+ o0 y9 ]7 v5 B - NVIC_Init(&NVIC_InitStructure);( A! K9 B( F0 a: n
- }
% A/ I" C: `3 a - 5 |, u# Z i# l. D
' ~3 ?! `: r% M$ D) v! i6 J0 |" E- //定时器6中断服务程序
- Q. Z# b! B* A; X5 ` C0 b9 i3 \ - void TIM6_IRQHandler(void) //TIM3中断0 ~! N/ [( g/ s( \' y, k
- {+ P& {4 w d1 D' e7 o$ ]$ E8 V, w
- if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET) //检查TIM3更新中断发生与否
3 h% a& s; a( ]3 V; F$ M - {, b; [8 g$ C& G9 O3 s* x6 P, B
- TIM_ClearITPendingBit(TIM6, TIM_IT_Update ); //清除TIMx更新中断标志
9 T. x0 b1 h8 o! W: h - msHcCount++;
+ u5 ^7 q2 Z" P, R J( `4 R$ `0 k - }
" c- {2 R4 c; A- x0 ?& l% [# K - }5 S2 g: |$ R9 X/ x% v S
- * Q! m4 _* g" p3 l1 ]
5 T! Y- J7 x r7 |, K( H- //获取定时器时间$ `6 x) w. K* x5 U' s7 h2 f% X
- u32 GetEchoTimer(void)
4 q9 P. w3 o l) P0 J6 s7 y - {! o; T& U9 n2 w0 v& K- f
- u32 t = 0;: z3 Z1 J N0 H. l- A5 y/ y# {- A- i" B* S
- t = msHcCount*1000;//得到MS
5 W$ P$ E2 F3 R2 `' n - t += TIM_GetCounter(TIM6);//得到US( q$ }. ]7 h) z! F
- TIM6->CNT = 0; //将TIM2计数寄存器的计数值清零
+ [. G7 v+ s0 ?8 z3 c' x9 t# E - Delay_Ms(50);; }$ o( j: H7 C, v; l4 r
- return t;, j7 n+ W6 `1 b$ I6 g: W" |5 K
- }" F. a3 t# g# p
- 4 ]" d5 z5 }2 J
- 6 l8 z+ D$ w- b% \
- //一次获取超声波测距数据 两次测距之间需要相隔一段时间,隔断回响信号3 W1 N& R$ b& w
- //为了消除余震的影响,取五次数据的平均值进行加权滤波。
" y" ]1 e- v& \% H: N B" H - float Hcsr04GetLength(void )
6 U1 S7 g% r- F$ a, v. E, f - {* M# `5 J# U9 g; o/ Z( z
- u32 t = 0;
" { v5 l! R9 c' x! M1 Z' `5 d$ L - int i = 0;
% U* n# S. O3 ?$ H' p0 \6 z - float lengthTemp = 0;. ~9 F: X$ A b: M2 H
- float sum = 0;. c1 T4 M' v. A
- while(i!=5)8 H! ?$ H9 q7 ?4 Y0 H- n
- {" ]! x3 q4 T: s7 V/ D9 x" \
- TRIG_Send = 1; //发送口高电平输出
; |* Z/ l/ K( f3 c - Delay_Us(20);
}1 C) ?' b' C0 G5 w - TRIG_Send = 0;
4 ^4 F4 G+ ~/ V: R - while(ECHO_Reci == 0); //等待接收口高电平输出
) e5 n. A) a; ^5 c/ W - OpenTimerForHc(); //打开定时器
1 r% |. r6 ]! m5 r- u - i = i + 1;+ I4 }) m( n' ]
- while(ECHO_Reci == 1);+ |. m) U3 ~4 z- Q
- CloseTimerForHc(); //关闭定时器% N# v4 r4 I. |' B! X" f
- t = GetEchoTimer(); //获取时间,分辨率为1US6 R: L0 p$ G' l! d" S
- lengthTemp = ((float)t/58.0);//cm
3 o+ b$ n i. j& T1 i) [ n - sum = lengthTemp + sum ;1 v- j4 X: r" f9 o5 B5 y7 q& v
- / _. j( Y) `) z5 E7 G8 o6 O
- }
# h2 C) @3 H. {+ o7 a( m, i - lengthTemp = sum/5.0;- {. p1 Y8 _4 @4 j
- return lengthTemp;
% N8 a7 D3 \: H: W. v0 a6 t - }
% n* ]6 @4 Z; r; b. Z5 ~ - - S. W' a* S3 `
- " D" m2 b) W% S9 L
- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::' C3 K% u8 w: t8 T" _6 K
- ** 函数名称: Delay_Ms_Ms
' @, R; g3 ?( O4 X& j! H9 Q! e - ** 功能描述: 延时1MS (可通过仿真来判断他的准确度)
- e5 l" H' A$ f& `) v1 ]# j! N - ** 参数描述:time (ms) 注意time<65535
- O2 y8 m) |6 B& R9 e A% R - :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
6 g0 Y( S2 j- I, p7 c/ D4 H - void Delay_Ms(uint16_t time) //延时函数
' ^3 H) V5 t. e. D+ m - {
% }4 K# C- Q0 W7 {$ H" { - uint16_t i,j;
+ d. Q1 U5 @" d. S4 v- F4 C - for(i=0;i<time;i++)1 N/ j! M- G, N, `( I: d6 s3 Q
- for(j=0;j<10260;j++);* p$ w7 o a9 f' i4 u
- }" _; R9 |: q& O0 a0 n1 M5 Y4 ]
- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::
8 D5 h6 m" ~9 j - ** 函数名称: Delay_Ms_Us
( {* h- G+ {" K4 o' H. l5 Y - ** 功能描述: 延时1us (可通过仿真来判断他的准确度)
, K8 |1 a+ a; ?4 ]3 z: K - ** 参数描述:time (us) 注意time<65535 4 A4 K* ]8 h2 T6 ~; }* Y
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/: ^8 I1 H+ Q$ e
- void Delay_Us(uint16_t time) //延时函数0 C# |1 T0 \+ j
- { + [: R1 q( P6 c& D$ P) B1 D" m
- uint16_t i,j;' J$ J7 n9 E2 Q5 s6 C: E
- for(i=0;i<time;i++)
" {( @- a: [2 W9 ] - for(j=0;j<9;j++);
% E! Z5 n. A+ [ - }
复制代码 3 g1 _8 q% [8 c0 O
但是关于USART的函数我就不往上写了,这个简单的串口打印大家应该都会写。下面简单贴一下我的主函数吧。 - /*" w+ N/ ^+ M& F8 N0 H1 a# b
- 教训:实验前一定要检查引脚连接是否正确,万不可搞错,不然又要烧坏芯片!!!!
! V. ^+ }3 D) X, e" u$ W0 o& G - n: X9 z/ V i# l
- */
- F6 L7 e3 ]- a0 D4 J/ A2 V8 i - 0 q" Z2 O$ U w) o$ o3 u, C
- #include "hcsr04.h"
$ M* n: O7 K. x/ r( v; b. S/ I - #include "chao_usart.h"
8 P- C) G, ?1 H8 M3 m# s - + a/ } p0 w; p! g
- int main()7 E% Z$ F$ Z2 [! h) R
- {
, B9 L. k1 j7 d - 6 U0 K! ~$ [8 w
- float length;
) M& u5 v1 I9 ~ - 6 |& W- U. I' H
- GPIO_cfg();
+ a& k. r" x0 m0 ~7 s. w - NVIC_cfg();7 {% V1 H0 U: g9 a1 t
- USART_cfg(); 4 ` x% G4 m# h, S3 A$ | R- v
- printf("串口初始化成功!\n");. _6 O9 y, W' n, L+ d" s* \4 B
- ) b6 N: H. Y- y- C9 r
- Hcsr04Init(); / r. }2 Y! f, R( {: V
- printf("超声波初始化成功!\n");//测试程序是否卡在下面两句上面 F3 x, D" c. o" @) O6 z; r4 I) {
- ! A3 ?# `* i7 N% f7 O& A Z
- length = Hcsr04GetLength();- h5 l- f! }: E$ Y/ f3 z' @- Q
- printf("距离为:%.3f\n",length);' a" W- S( V% r5 u/ x" M" F
-
# A6 l9 t5 i1 [( D" ~- w3 |/ r - # t# v8 U9 H% E
- }
复制代码 . F* P9 u7 S' z! M+ I3 W( ^
: G9 c1 B; Q% i' a5 J* i% M
实验结果:
0 a+ M S& w/ R! R
3 m1 ?9 E% a8 k7 t+ H
/ [; n' x% h$ [3 K好了,其实这个模块很简单,但是要是把他用的很好的话还是比较困难的,比如用超声波做一个四轴定高的程序,还是有一定的挑战性的。 写这篇博客的目的不仅仅是介绍这个模块的使用,其实这种使用介绍网上一搜一大把,我只是想纪录一下,我在做这个模块的时候遇到的一些其他的问题。 其中有一个小插曲,就是当吧写好的程序烧进去之后,运行时总是出现每次返回一个同样的比正常值小的多的数据,比如说0.034cm,这明显是一个错误的数据,但是刚开始的时候,不知道为什么 总是这样,多次复位从新上电总是这一个数据。让我很是苦恼。但是幸运的是,在这样的情况中间,他又会有时出现一两个正常的的数据,让你有点摸不着头脑。 上网查了一下才慢慢明白,这种现象叫做“余震”,网上关于余震的解释大致有三种: 1、探头的余震。即使是分体式的,发射头工作完后还会继续震一会,这是物理效应,也就是余震。这个余震信号也会向外传播。如果你的设计是发射完毕后立刻切换为接收状态(无盲区),那么这个余震波会通过壳体和周围的空气,直接到达接收头、干扰了检测(注:通常的测距设计里,发射头和接收头的距离很近,在这么短的距离里超声波的检测角度是很大的,可达180度)。( V3 r( z/ R; ^3 J9 Q: L4 q
2、壳体的余震。就像敲钟一样,能量仍来自发射头。发射结束后,壳体的余震会直接传导到接收头,当然这个时间很短,但已形成了干扰。另外,在不同的环境温度下,壳体的硬度和外形会有所变化,其余震有时长、有时短、有时干扰大、有时干扰小,这是设计工业级产品时必须要考虑的问题。
3 X6 @; W+ f. s* N 3、电路串扰。超声波发射时的瞬间电流很大,例如某种工业级连续测距产品瞬间电流会有15A,通常的产品也能达到1A,瞬间这么大的电流会对电源有一定影响,并干扰接收电路。通过改善电源设计可以缓解这种情况,但在低成本设计中很难根除。所以每次发射完毕,接收电路还需要一段时间稳定工作状态。在此期间,其输出的信号很难使用。 * v. d9 r( p I" R1 \6 j+ o1 y
消除上述现象的方法之一就是在检测的时候多次循环检测,取平均值,也就是加权平均滤波,一个简单的滤波处理。就是下面这一段: - int i = 0;' K8 G8 e6 j5 U# i7 _3 e
- float lengthTemp = 0;
# G* v( e6 `, i- H/ j - float sum = 0;0 q% `5 W! r9 A6 ~ E
- while(i!=5)
5 N' c H7 j% B; @ - {
% e, l8 V7 Z. \& g9 c% J! Y - TRIG_Send = 1; //发送口高电平输出1 d1 P7 A' [! v4 ^- d
- Delay_Us(20);# `' G$ o6 I, R! e
- TRIG_Send = 0;
1 t" k4 u: V+ |& @ - while(ECHO_Reci == 0); //等待接收口高电平输出& y1 }5 S* K& F+ V! B0 h' E
- OpenTimerForHc(); //打开定时器& [$ }/ z: N* V' f9 S @
- i = i + 1;5 W' V" X- e% N/ i
- while(ECHO_Reci == 1);. V E$ T8 j$ V" P6 f. ?( X# y2 z6 x
- CloseTimerForHc(); //关闭定时器% i2 h" T9 K" p+ I7 E" m1 D
- t = GetEchoTimer(); //获取时间,分辨率为1US
' J" Y& r) ~$ Z9 k1 M9 ]1 g' L - lengthTemp = ((float)t/58.0);//cm3 S! U( ?* G( ?0 K: h- w
- sum = lengthTemp + sum ;$ H4 E4 E! K+ c3 K! d0 m7 C6 r" l) I
-
. b( _# ?. P, E2 n" f - }% G5 h1 B \1 ~2 m" ~
- lengthTemp = sum/5.0;
0 |& ]5 `4 r+ M/ d* x0 R( _ - return lengthTemp;
复制代码
+ H! t: e0 U2 b7 a
: C1 M: ~- Y' J5 ^: B! K加了这个之后,基本上就没有出现余震现象了。 还有一点就是测试程序前一定要检查引脚有没有接错,不管多有把握,也要看一遍,不然很容易出大事的,一个芯片也许就因为你的大意给GG了。切记,这个应该也算我们这个行业的基本素养吧。 ( o2 o) ]% o2 b; e6 ^- y( C- i; [
|