|
首先,先来看一下这个模块的基本功能和原理。 HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能,测距精度可达高到3mm;模块包括超声波发射器、接收器与控制电路。像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。 注意是5v输入,但是我用stm32 的3.3v输入也是没有问题的。 1 O* w d$ S1 E# R: s, G. r% a9 C
" U+ L, q/ x# {
二.工作原理 1.给超声波模块接入电源和地。
7 ~0 s7 [/ C- s8 F9 W& j# L 2.给脉冲触发引脚(trig)输入一个长为20us的高电平方波 3.输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;(此时应该启动定时器计时)& a0 J0 p0 K& P0 v
4.当超声波返回被模块接收到时,回波引 脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长。* ?/ i) b, D' W0 W4 c% C2 r G
5.根据声音在空气中的速度为344米/秒,即可计算出所测的距离。 要学习和应用传感器,学会看懂传感器的时序图是很关键的,所以我们来看一下HC-SR04的时序触发图。
/ G7 r/ L$ `5 ? 我们来分析一下这个时序图,先由触发信号启动HC-RS04测距模块,也就是说,主机要先发送至少10us的高电平,触发HC-RS04,模块内部发出信号是传感器自动回应的,我们不用去管它。输出回响信号是我们需要关注的。信号输出的高电平就是超声波发出到重新返回接收所用的时间。用定时器,可以把这段时间记录下来,算出距离,别忘了结果要除于2,因为总时间是发送和接收的时间总和。 下面是亲测可用的驱动程序。 芯片型号为stm32f103zet6,超声波测距后通过串口打印到电脑上面。 驱动和测距; - //超声波测距2 M5 i4 t0 O) t2 i/ D& i
- 0 w, A; y) J1 q7 P8 Z" R0 Q
- #include "hcsr04.h"
( \4 t* R$ ^% N+ I& C. ^+ d -
- S1 S5 y. T6 g6 h# t - #define HCSR04_PORT GPIOB/ N; s) N2 v( r' E) G) O
- #define HCSR04_CLK RCC_APB2Periph_GPIOB/ `% d; g8 r; C% e
- #define HCSR04_TRIG GPIO_Pin_5
4 N* L& [0 J( K2 R9 Q& S - #define HCSR04_ECHO GPIO_Pin_6' e% ~% O3 U" w7 y) y$ y! m
- & {4 D" _# B# u: V c$ l/ J
- #define TRIG_Send PBout(5) % e" J4 y6 ~9 |7 ^
- #define ECHO_Reci PBin(6)0 p3 w7 z2 z# x
0 @ N3 \6 ^6 e5 [$ h' T D& u: ]- u16 msHcCount = 0;//ms计数
9 r( a( P. \# t, w, g4 p/ C
6 s/ ?$ ]- K' [3 R- void Hcsr04Init()! {; D9 [: R r$ ` o2 g
- {
' _ M, F, A& f - TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; //生成用于定时器设置的结构体! C; Y5 ^# B) ^7 c2 z: H; U
- GPIO_InitTypeDef GPIO_InitStructure;5 u( I1 x4 k$ D5 N7 ~4 n
- RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);) R7 b0 y9 n: g
- 4 ^+ a2 w/ g# t1 C7 K4 l
- //IO初始化
( ^/ m: P3 v* j% Q3 ?& k" h1 j - GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG; //发送电平引脚* K% |5 v ?( Q9 C( P' ~
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
8 q% A; A6 Y4 [, M! F$ E - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出
4 b, }% e. `0 n R& |8 C - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);
) G* {- a1 s8 R R3 ? - GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);( ?; p- X& u+ g2 v
- : J3 [( c2 C. Q* q
- GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO; //返回电平引脚
?- e! r6 s7 e' j1 n& }, d - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入7 t- F1 U9 y* U. r5 b
- GPIO_Init(HCSR04_PORT, &GPIO_InitStructure); , Z7 K2 x' B2 P* p
- GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO); 2 \ i. H+ o( F% h7 [2 j, ]
- 4 S8 B( w6 o+ d4 a
- //定时器初始化 使用基本定时器TIM6
7 }2 q* S2 d( x/ O. I; R% Z1 J - RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //使能对应RCC时钟
1 W, E8 F$ t, ?1 D6 p - //配置定时器基础结构体
3 Y/ ~5 e7 n$ d# K! O1 V' t - TIM_DeInit(TIM2);
) Q. Q+ ~/ W* s% M! p - TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值 计数到1000为1ms- }$ w$ t, S. b& f) H% `5 z; P9 Y
- TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值 1M的计数频率 1US计数# I9 O: V, b" m1 J4 q4 ^6 h7 l
- TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频4 F+ U' u! \/ _
- TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式4 e# Z2 ]- U0 e( l. @9 y& ]5 b
- TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位 ; j5 u" J% n& r1 b
-
: V2 A+ X$ e: Q! n% l* `7 x7 U( n - TIM_ClearFlag(TIM6, TIM_FLAG_Update); //清除更新中断,免得一打开中断立即产生中断: ]& }) l9 e, g( s% J% J/ y
- TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); //打开定时器更新中断9 e0 Q S; e4 F$ b; C, Z
- hcsr04_NVIC();" Y0 \& A$ L, ]1 w/ U
- TIM_Cmd(TIM6,DISABLE);
4 l4 k6 W& o% \0 a: H3 L% l - }
+ c' l7 a8 |! ]; h) P - 7 J# ]( F9 ^$ q" r H8 w
- % ^% V3 W6 e& M/ \
- //tips:static函数的作用域仅限于定义它的源文件内,所以不需要在头文件里声明/ m+ s7 g) Q$ x W& k9 i+ {
- static void OpenTimerForHc() //打开定时器
* |) K/ @6 _9 d$ A7 p - {* ~" a. N2 {+ ~ e% ^
- TIM_SetCounter(TIM6,0);//清除计数
$ J, }& d$ O: `, q; v* w - msHcCount = 0;8 _; f' j% C7 U' C7 V8 S5 g
- TIM_Cmd(TIM6, ENABLE); //使能TIMx外设
* U; C* b! j3 [& D3 Q$ D2 p5 d - }
' s( m2 _4 v5 \1 n; ~ -
7 d4 k$ L8 k" `$ M- F2 W3 l - static void CloseTimerForHc() //关闭定时器
- ~9 t0 T7 U0 R% R% E& z - {% n2 F z& e+ B$ j7 S7 l/ s, V) i
- TIM_Cmd(TIM6, DISABLE); //使能TIMx外设
8 ]+ X% I/ Y' L7 w$ k: k+ w1 u - }
. L3 a5 |, k! s$ F* P5 h" t$ r -
' U5 z7 W- G1 w9 ^" f7 W) h -
" ?# p- l3 _0 [) |, f; T4 m1 J: U( s. ] - //NVIC配置/ G! G6 e- J R8 D
- void hcsr04_NVIC()0 _% O# Q+ {$ E0 g" z
- {7 |4 X& h: m+ R/ N3 i
- NVIC_InitTypeDef NVIC_InitStructure;
: v5 ^9 s, X- W: e# C* V6 [( ? - NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
. [- _2 ~; i. e% U - 5 c6 z$ ^5 u9 w0 e' n- ?1 H! c
- NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn; //选择串口1中断3 i' d! y) m8 O3 {: i! }/ K
- NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占式中断优先级设置为1
3 \( B3 v& J/ p: `5 x3 \ - NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //响应式中断优先级设置为1
. ^6 m1 q! A$ D - NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能中断
9 I, n8 R5 V+ `+ }1 c* w - NVIC_Init(&NVIC_InitStructure);9 M- Z3 f' S* o( I: B' l
- }
: C9 w# v2 {* C - H3 U0 c- C! n; p: h5 t& o
/ K3 X$ H1 s: g7 M- //定时器6中断服务程序
4 v0 B8 \* \% V/ h' ~3 } - void TIM6_IRQHandler(void) //TIM3中断
O" c7 ^* a0 g; j - {
& E6 R) v3 r' j - if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET) //检查TIM3更新中断发生与否
) \6 a( u! c, T! p/ A6 L - {
. S* m5 p; L0 X$ x8 q - TIM_ClearITPendingBit(TIM6, TIM_IT_Update ); //清除TIMx更新中断标志
8 C {: E& \0 K ^0 G2 `, s - msHcCount++;
3 x3 O+ a9 f0 Y7 r+ m - }
6 |" w6 H; y9 F# J - }
4 k& l) _) T; D; P6 b - 9 F7 e' {' m2 D+ f( y0 I& d& m
! g, ~7 y" K7 _9 d* z) l- //获取定时器时间
6 S- g6 ~) p r - u32 GetEchoTimer(void)
$ Y1 f& L( Z% M7 y- D' b& X& P - {/ N7 e% d/ [/ C. z- T3 w- D/ r0 I
- u32 t = 0;- Y/ A5 a9 V k( g P' R
- t = msHcCount*1000;//得到MS
" M9 B8 M. w2 z0 H1 `$ { - t += TIM_GetCounter(TIM6);//得到US" n" I/ x) k x7 B
- TIM6->CNT = 0; //将TIM2计数寄存器的计数值清零8 C! U5 p! _5 v" k$ i- e& I+ P
- Delay_Ms(50);
$ \8 Z4 A0 p* |6 S$ d: s5 [ - return t;! ], A+ v7 d7 d
- }
; E! N' N7 y( u+ m- Y/ @! B - # @$ o/ C \) S/ `- l3 f7 {
0 Z; a( p! r7 a5 I- //一次获取超声波测距数据 两次测距之间需要相隔一段时间,隔断回响信号: F* P1 E% t5 b
- //为了消除余震的影响,取五次数据的平均值进行加权滤波。% }) S+ `, Z6 v! i. J) i
- float Hcsr04GetLength(void )9 |' W* K' S) H/ f, ?! G- L
- {
6 p; J& H f3 c) g - u32 t = 0;
' u- ]; H8 q. Z$ o! w5 C7 n - int i = 0;. f% Y2 ^- x9 L+ G+ {4 T- F2 C
- float lengthTemp = 0; f; z- H6 _( g1 h' o, }5 n
- float sum = 0;
- M& T* |; S5 p7 Z/ F; s - while(i!=5)3 k8 c/ T/ R3 B' R. p' u
- {
* r" n% F; X6 {4 v4 d# [ - TRIG_Send = 1; //发送口高电平输出
- G; G' K8 S: A9 H - Delay_Us(20);+ F& B" {3 C1 R, B, s
- TRIG_Send = 0;% H0 `% { U& U1 Z: y! I2 y
- while(ECHO_Reci == 0); //等待接收口高电平输出
2 ~* f5 |7 C6 P- [! m - OpenTimerForHc(); //打开定时器
1 G2 S9 t9 i% o6 ` - i = i + 1;
# n) e) \5 @1 V7 K' ^- J - while(ECHO_Reci == 1);' Z1 q6 [" t( V7 P; q; W
- CloseTimerForHc(); //关闭定时器- o, U7 i8 M7 U) E G
- t = GetEchoTimer(); //获取时间,分辨率为1US
5 R+ z( P7 P4 ^0 V0 I4 G U - lengthTemp = ((float)t/58.0);//cm
! r1 q9 j- w- b& p - sum = lengthTemp + sum ;" N1 x4 Q! f( D
-
0 [; y) B! N0 ^ - }* A; \8 u% w0 O; {0 W2 B! d# |
- lengthTemp = sum/5.0;8 d+ t+ Y5 M( B5 u6 R* P0 D
- return lengthTemp;
Q% j; r- e# u# r) z* u0 p - }& y. i$ g$ c2 B& ^0 L) r- D
. p6 h( {2 y+ b% I
' J/ ^* p/ z& l- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::
6 J9 b, g& R) _- _8 M - ** 函数名称: Delay_Ms_Ms* r5 S; _ n) E7 x
- ** 功能描述: 延时1MS (可通过仿真来判断他的准确度) 3 D% y$ Y, L) Z; J; p2 K* M
- ** 参数描述:time (ms) 注意time<65535 F }$ u f. ?' @$ n5 @& Q2 q- w
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/3 J' w. q+ S; |7 ?# y. f
- void Delay_Ms(uint16_t time) //延时函数1 s: V& \7 r% r
- { 1 n2 o7 m$ y3 ~4 i6 t3 z! {
- uint16_t i,j;7 n' \! U8 ?8 L& k9 x ?
- for(i=0;i<time;i++): G; {, Z& n: O3 _* o0 N& @8 M8 P# S
- for(j=0;j<10260;j++);( v$ O' L+ [- K9 M& `+ v+ o
- }
$ h/ f+ v+ v& _0 z" D - /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::
* M: b' i$ v+ \' i& Q - ** 函数名称: Delay_Ms_Us
% X- C" U8 ~8 k4 Q2 a0 g& q - ** 功能描述: 延时1us (可通过仿真来判断他的准确度)
* L r# U3 Q$ Q' k9 p, w, e: B - ** 参数描述:time (us) 注意time<65535 F x3 l7 u% M1 k5 r# w
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/. n! W% M9 [- ]4 Z
- void Delay_Us(uint16_t time) //延时函数
1 _) F1 ]' K0 ] - {
5 A( Q) }. h- v3 A/ x9 U8 x. Z4 N - uint16_t i,j;2 c. ~7 l; E; t6 J- `! ^. `
- for(i=0;i<time;i++)
8 L' O) g% j8 ` E [, F - for(j=0;j<9;j++);
1 P6 V0 |4 D: K: |2 K2 C7 a - }
复制代码 6 X {* I& h& k1 d) i
但是关于USART的函数我就不往上写了,这个简单的串口打印大家应该都会写。下面简单贴一下我的主函数吧。 - /*
$ ?7 W9 t9 G# L9 R! ^* o5 v; C - 教训:实验前一定要检查引脚连接是否正确,万不可搞错,不然又要烧坏芯片!!!!: U, M/ N$ ^( J8 L: E2 L" _7 l1 v
; a+ k- M+ \: E% O/ T, o" g- */2 Q9 \$ B; R. a* v& b" |
- / H$ ` Z5 p$ i1 f/ p3 S) ~, R
- #include "hcsr04.h"
' x. ?7 s6 [2 W9 h, A - #include "chao_usart.h"/ N L$ K- `9 Q5 A, T, o+ w
- ; s' n- O5 u- Z$ i6 a' h
- int main()
2 ]2 a' d0 H7 l3 f* o; I, X2 V - {
5 ^- c2 K% o' m! b( q8 Y - 2 l* D- [% i$ R& x$ m+ n
- float length;
2 H2 W1 g) T1 v% R0 I -
9 f% {- |! d Q" @7 b$ Y) @" } - GPIO_cfg();/ Z% @5 V. k; R8 w" K% Q' p4 e
- NVIC_cfg();
! B0 ]. N% R% k - USART_cfg(); 9 i, w9 w1 Q# Q' t% v
- printf("串口初始化成功!\n");
, n# }/ V3 J0 H Q( Y -
" }& q0 O% r9 e( m - Hcsr04Init(); 4 v6 ^' {$ l! D7 j& q1 h* q
- printf("超声波初始化成功!\n");//测试程序是否卡在下面两句上面
( F7 \6 z/ U( ]: t% t - , a \9 x7 `1 B/ E) ?3 k5 v
- length = Hcsr04GetLength();
# ]# s- w7 o }' }. V. d# ?! a - printf("距离为:%.3f\n",length);3 c. L7 T9 k7 F/ X7 [8 s x
-
R# x4 Z) T2 D - % E9 H7 q8 P0 k {) O
- }
复制代码 5 C7 s$ Y0 f, h+ ^& D* j
' |0 M" u" e2 I+ U" T实验结果: 8 p ], z9 W( a5 h
1 c% Q1 i( r1 b+ S' s
6 m: u' V) j0 z好了,其实这个模块很简单,但是要是把他用的很好的话还是比较困难的,比如用超声波做一个四轴定高的程序,还是有一定的挑战性的。 写这篇博客的目的不仅仅是介绍这个模块的使用,其实这种使用介绍网上一搜一大把,我只是想纪录一下,我在做这个模块的时候遇到的一些其他的问题。 其中有一个小插曲,就是当吧写好的程序烧进去之后,运行时总是出现每次返回一个同样的比正常值小的多的数据,比如说0.034cm,这明显是一个错误的数据,但是刚开始的时候,不知道为什么 总是这样,多次复位从新上电总是这一个数据。让我很是苦恼。但是幸运的是,在这样的情况中间,他又会有时出现一两个正常的的数据,让你有点摸不着头脑。 上网查了一下才慢慢明白,这种现象叫做“余震”,网上关于余震的解释大致有三种: 1、探头的余震。即使是分体式的,发射头工作完后还会继续震一会,这是物理效应,也就是余震。这个余震信号也会向外传播。如果你的设计是发射完毕后立刻切换为接收状态(无盲区),那么这个余震波会通过壳体和周围的空气,直接到达接收头、干扰了检测(注:通常的测距设计里,发射头和接收头的距离很近,在这么短的距离里超声波的检测角度是很大的,可达180度)。
8 M3 h, F; W. u0 b 2、壳体的余震。就像敲钟一样,能量仍来自发射头。发射结束后,壳体的余震会直接传导到接收头,当然这个时间很短,但已形成了干扰。另外,在不同的环境温度下,壳体的硬度和外形会有所变化,其余震有时长、有时短、有时干扰大、有时干扰小,这是设计工业级产品时必须要考虑的问题。. v9 e+ t" T6 u* v5 N$ r
3、电路串扰。超声波发射时的瞬间电流很大,例如某种工业级连续测距产品瞬间电流会有15A,通常的产品也能达到1A,瞬间这么大的电流会对电源有一定影响,并干扰接收电路。通过改善电源设计可以缓解这种情况,但在低成本设计中很难根除。所以每次发射完毕,接收电路还需要一段时间稳定工作状态。在此期间,其输出的信号很难使用。
/ f4 T3 D( d5 d8 O2 q消除上述现象的方法之一就是在检测的时候多次循环检测,取平均值,也就是加权平均滤波,一个简单的滤波处理。就是下面这一段: - int i = 0;
! s! o, h, f8 X2 \ - float lengthTemp = 0;% K+ D3 k' G7 i1 [8 B* ?
- float sum = 0;
8 z4 U, v, u# g8 c- D' Y - while(i!=5)' y: P6 y9 H$ \* v* J
- {0 d3 l& `# s+ X9 ~$ S9 @; k- }
- TRIG_Send = 1; //发送口高电平输出
6 Y6 G. F- o4 k - Delay_Us(20);0 y" v- j# y; u2 ]
- TRIG_Send = 0;
X7 d- b3 @" ^! [: g - while(ECHO_Reci == 0); //等待接收口高电平输出
6 [$ T% m4 R, Q- F9 c- G. @. P - OpenTimerForHc(); //打开定时器
0 j3 m5 o4 H( x! D - i = i + 1;1 f! {, b; c3 C4 _
- while(ECHO_Reci == 1);
0 i, U3 `7 ?. l- \9 J' s! X% x - CloseTimerForHc(); //关闭定时器- h6 w, i0 h3 J2 r7 c; \
- t = GetEchoTimer(); //获取时间,分辨率为1US% m% F& v! O# q
- lengthTemp = ((float)t/58.0);//cm
/ Q( w$ f, ]! e) U+ e - sum = lengthTemp + sum ;
- O) n6 ^5 z- L5 q - $ {; x, E$ @5 f
- }
, O9 G- o l0 W5 s$ v - lengthTemp = sum/5.0;7 L! c# E, n, Y6 b7 e: L: L' x, O
- return lengthTemp;
复制代码 ; c) z0 M9 E' G: y' C, ^8 J
; D$ p, x$ ^1 B
加了这个之后,基本上就没有出现余震现象了。 还有一点就是测试程序前一定要检查引脚有没有接错,不管多有把握,也要看一遍,不然很容易出大事的,一个芯片也许就因为你的大意给GG了。切记,这个应该也算我们这个行业的基本素养吧。 - {% H6 \ W+ v. m; g
|