|
首先,先来看一下这个模块的基本功能和原理。 HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能,测距精度可达高到3mm;模块包括超声波发射器、接收器与控制电路。像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。 注意是5v输入,但是我用stm32 的3.3v输入也是没有问题的。 ! ?$ _' {- o4 ~! A1 |6 O, E3 s( Z
0 R {! }" W3 A6 Q, }1 t$ y) ^
二.工作原理 1.给超声波模块接入电源和地。
: L: D' i# @ P8 }- j# t+ Z+ ` 2.给脉冲触发引脚(trig)输入一个长为20us的高电平方波 3.输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;(此时应该启动定时器计时)
' T% u+ d1 f0 n+ b 4.当超声波返回被模块接收到时,回波引 脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长。
7 i: T3 [1 g$ \. i% [ 5.根据声音在空气中的速度为344米/秒,即可计算出所测的距离。 要学习和应用传感器,学会看懂传感器的时序图是很关键的,所以我们来看一下HC-SR04的时序触发图。 - D; b; A# O; E! m7 [# v' |5 i
我们来分析一下这个时序图,先由触发信号启动HC-RS04测距模块,也就是说,主机要先发送至少10us的高电平,触发HC-RS04,模块内部发出信号是传感器自动回应的,我们不用去管它。输出回响信号是我们需要关注的。信号输出的高电平就是超声波发出到重新返回接收所用的时间。用定时器,可以把这段时间记录下来,算出距离,别忘了结果要除于2,因为总时间是发送和接收的时间总和。 下面是亲测可用的驱动程序。 芯片型号为stm32f103zet6,超声波测距后通过串口打印到电脑上面。 驱动和测距; - //超声波测距
/ S$ n1 }4 }3 t/ K/ l - 4 a7 s0 Y3 V! a/ V+ N; |: J
- #include "hcsr04.h": M t- k: I( t+ ?# V' d! Y
-
& Y5 k' ]+ ~6 d' g - #define HCSR04_PORT GPIOB
, K: v. }; k) v4 o - #define HCSR04_CLK RCC_APB2Periph_GPIOB4 G4 x7 c9 U% o* w
- #define HCSR04_TRIG GPIO_Pin_5
+ n7 h( [; G1 I( G. v; A% o* } - #define HCSR04_ECHO GPIO_Pin_64 t) ]/ Y/ _/ {- v7 F
- . V: S" J8 \; {- o% i+ \* N
- #define TRIG_Send PBout(5)
3 Q4 @% \4 P; d' E6 n - #define ECHO_Reci PBin(6)2 U: @+ _8 S2 d" s. v8 Y
- & j) O& T" I2 m- W& w$ C
- u16 msHcCount = 0;//ms计数6 v/ Q- u0 i) o& Y
- * c# y0 X+ w/ }4 m0 ~( i& V
- void Hcsr04Init()
( x7 l! N4 v2 }3 y+ C - {
: b) @+ j/ X4 b8 @2 h: m - TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; //生成用于定时器设置的结构体& h* o& ~, I9 Z; w8 J
- GPIO_InitTypeDef GPIO_InitStructure;$ Z4 J4 K% R0 N. B0 `' ]0 {2 @0 i
- RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);; l' G) M+ ]3 Z; Y- l, X, z+ G, v! y- c
- 2 R9 t* h: R$ X2 l5 e
- //IO初始化3 g. v: a5 B' k
- GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG; //发送电平引脚2 ?: l& m( d7 h. G
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;7 K3 f4 a/ q' o8 [6 k
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出2 g/ D) c5 z( v4 N
- GPIO_Init(HCSR04_PORT, &GPIO_InitStructure); D3 J `8 |* s* T ]5 L/ m) I0 i. E+ n
- GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);
0 U* I' Z r# x0 P -
7 [. o' ~0 T2 \% x8 i6 T" s0 B - GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO; //返回电平引脚
% u: i: s# f0 v7 O7 Q7 O - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
7 \$ c9 G, r) e4 Q, L m - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure); + z' v$ `+ c' l% a% C) u$ K
- GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO); ( ]* ?: Z: w2 V5 Q- t2 a4 R6 ]2 @
-
) F {8 H! {1 @. j7 r1 e - //定时器初始化 使用基本定时器TIM68 q% r9 o; H& E* ]) {. w
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //使能对应RCC时钟
5 ?5 ]0 S, `, Y - //配置定时器基础结构体
9 p# o0 p: j8 M/ m2 D& Y1 } - TIM_DeInit(TIM2);
1 p# @& a: |* @2 P& e/ K - TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值 计数到1000为1ms
2 z( F5 Q+ p. E - TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值 1M的计数频率 1US计数
, @2 o* i0 }5 S7 E! p' M9 P - TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频
+ o4 @ t% r- C% @' s# F - TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式% s, ?- K$ y4 [) S
- TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
( R' s7 C& Q: d* X) v& g - ) l: m. y) `( j& A
- TIM_ClearFlag(TIM6, TIM_FLAG_Update); //清除更新中断,免得一打开中断立即产生中断- M9 y, i4 e, V$ ~! ^
- TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); //打开定时器更新中断
6 g3 H+ l: d; \9 H5 f8 Z - hcsr04_NVIC();8 c. c# g4 X1 S; I7 @9 g. o* g( L) ~
- TIM_Cmd(TIM6,DISABLE);
4 i9 B. f3 w0 l" A& X - }
. x* ?, L0 Z3 J3 E# }& i
N2 r0 `( q }# L9 {0 Y- , y5 X- s: @3 A" ]0 j
- //tips:static函数的作用域仅限于定义它的源文件内,所以不需要在头文件里声明" t. ^7 u0 H0 K" Y, |8 ]* W
- static void OpenTimerForHc() //打开定时器
2 ~" C9 y* Q) m4 P: A0 l& U1 h - {* Y: x6 J5 ]: Z) A7 S: T" t5 {3 @; V9 s
- TIM_SetCounter(TIM6,0);//清除计数5 z+ @& x$ ~1 d2 c. n; F3 W! l. ~
- msHcCount = 0;
/ K7 D( ~" ]" M - TIM_Cmd(TIM6, ENABLE); //使能TIMx外设8 }. `7 I# ], g' H
- }
% W. y2 b& e: _/ b -
6 Q" ^+ G/ x/ I% i' d - static void CloseTimerForHc() //关闭定时器
9 H. X# z5 e3 R$ E6 W - {. k# Z5 z3 b' d: l) o% y
- TIM_Cmd(TIM6, DISABLE); //使能TIMx外设4 _5 Y3 ~2 [' i9 u# n4 C
- }
* x# V1 m' z8 c& E7 G& n - ) \2 U y0 O+ J
-
+ X6 o2 D. V$ g5 M0 v - //NVIC配置" L; d. B7 i) R
- void hcsr04_NVIC(), ^( N b" A& m5 ^7 L
- {/ Y$ U( m5 `7 W8 V
- NVIC_InitTypeDef NVIC_InitStructure;
2 N/ G- O: r4 |% n, M6 P - NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);& \3 K5 {( ]- w
-
+ z) M, Q8 F$ W) f0 t - NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn; //选择串口1中断' z( ~+ b+ L9 F2 m6 C- ? v* R6 N
- NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占式中断优先级设置为1& ] g5 m. w7 i/ D
- NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //响应式中断优先级设置为1/ k2 W4 B* n' v0 I( J2 v
- NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能中断
) D$ @! b5 v6 m9 Y" v - NVIC_Init(&NVIC_InitStructure);& J* A: H" v; n- ^
- }( J! @8 U( T) w$ ~4 J+ \$ a
5 T; q% N. I4 p( k8 N* H- * m# P" Y" m8 F6 g# K0 {, G
- //定时器6中断服务程序
' }8 h, K- J) {# C/ g! Z0 V - void TIM6_IRQHandler(void) //TIM3中断
# k$ R9 K$ t5 D! u8 m - {
; u$ {9 V$ W. z8 U+ p - if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET) //检查TIM3更新中断发生与否1 o* y7 K5 K4 P. C. J
- {: A- A" c5 V+ n2 i" m9 g @
- TIM_ClearITPendingBit(TIM6, TIM_IT_Update ); //清除TIMx更新中断标志 3 [1 V4 d, ?! r5 E- Z) N6 r( q
- msHcCount++;9 M5 P' S3 B0 h# O+ ?
- }
. `5 R7 u" E$ r% Z7 T4 q: z - }
' R3 t0 `1 y; m) B3 r6 J - $ N9 w. t& a8 q
! D. `5 V, i0 L7 d$ _- //获取定时器时间' T( i8 k: n; W) e& o1 j
- u32 GetEchoTimer(void), Z0 p) Q* X5 x. D$ ]9 z
- {
$ [5 h- j# K& n) p/ I2 d4 A - u32 t = 0;
$ B' e9 z2 a6 P$ R0 `3 q - t = msHcCount*1000;//得到MS; j6 w* u, T% }3 d/ X
- t += TIM_GetCounter(TIM6);//得到US; {* a- b2 [* J
- TIM6->CNT = 0; //将TIM2计数寄存器的计数值清零8 S( z/ u" ^; H$ N+ @
- Delay_Ms(50);
, G" s( Q. b4 A- u8 X$ z, Y# Y* [, O6 Q - return t;
7 G% ^1 k* z) O - }
& F( r0 R2 J' W - 5 H4 X2 m) h- l
7 v! N6 S; ~/ ?2 r# L0 O- //一次获取超声波测距数据 两次测距之间需要相隔一段时间,隔断回响信号
* P. H6 R y- {' t( n - //为了消除余震的影响,取五次数据的平均值进行加权滤波。
/ C) z2 _2 h* V8 h. x - float Hcsr04GetLength(void )
8 y, \/ h' f" ]) |$ g) } - {
0 S* D3 B' H+ j( y& O; S* ^ - u32 t = 0;* n/ m8 U! ~( `; C0 W
- int i = 0;
- V' M: R6 [% }1 V - float lengthTemp = 0;4 O$ x% g5 G U! {& a7 X9 F2 `) x3 b
- float sum = 0;/ S, e3 g: C0 k, w u- s$ G2 f
- while(i!=5)
( P- \5 d& D% g& ^ - {
5 x5 D, f; u+ z5 k6 [3 ]: s" J - TRIG_Send = 1; //发送口高电平输出
& k9 o1 I& j4 T7 _+ d( r9 J1 v - Delay_Us(20);
7 v- Q4 F/ t* d/ W1 d - TRIG_Send = 0;
% k! G. @' r, [0 V, E5 O5 A8 [ - while(ECHO_Reci == 0); //等待接收口高电平输出
! @1 G- B, f1 G) [ - OpenTimerForHc(); //打开定时器
( w2 u u# ]& F2 K# ~ - i = i + 1;
: S0 t {! X" @& ]7 C, D1 m - while(ECHO_Reci == 1);
2 I# x% n3 G" _/ e! ]$ W$ I - CloseTimerForHc(); //关闭定时器
0 A% x2 O. W, v - t = GetEchoTimer(); //获取时间,分辨率为1US
5 S( S; m/ o, J1 E* U - lengthTemp = ((float)t/58.0);//cm
8 l6 g! h# o4 W! b - sum = lengthTemp + sum ;
5 {- B( r, Z% p0 e5 ? - 6 J% C' v6 Y4 i+ y
- }, I, J( c' M; ^
- lengthTemp = sum/5.0; L5 I, w* L. M" t4 D
- return lengthTemp;
* c9 m3 L. A9 I$ }0 }0 x* n - }( F' }, M4 k- n/ ]7 r1 x5 h
- $ [0 ~# p( @4 O- F. H# Y; x
# ?- S4 @6 ~2 i$ i3 ~$ |: O3 K- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::. z" K# A- r4 t. y; S: C
- ** 函数名称: Delay_Ms_Ms
' `# U9 Z* \% I; G8 M - ** 功能描述: 延时1MS (可通过仿真来判断他的准确度)
3 i/ h7 `. F" o6 T4 h+ _! ^ - ** 参数描述:time (ms) 注意time<65535
* t9 Y7 ~+ F6 b2 A/ e+ z0 |5 q9 d* Q - :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/' L! q4 f* G, U4 v# }
- void Delay_Ms(uint16_t time) //延时函数4 w$ R3 c* f& {: g! G5 e
- { # U5 p/ U1 a9 u& V5 ]
- uint16_t i,j;$ Y1 K3 S6 A0 @! _( Z$ z9 @
- for(i=0;i<time;i++)9 N" Q4 f1 w- K$ A" E( ?9 P
- for(j=0;j<10260;j++);% \+ a3 _( N0 G. a1 r! Q
- }
/ x2 [' W: w# [/ P - /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::9 z: t' y1 r2 ]* Z& F
- ** 函数名称: Delay_Ms_Us
! i$ p+ y8 m; M" |2 k6 y" | - ** 功能描述: 延时1us (可通过仿真来判断他的准确度) O& _& p% ~- i' N" l- n
- ** 参数描述:time (us) 注意time<65535 ; ~! u0 R2 k7 h( x; ^5 i
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/- W- a4 s+ ^( K
- void Delay_Us(uint16_t time) //延时函数
$ s) I9 X3 U+ v5 l+ D - {
) x S& \0 q+ @2 P( W' j - uint16_t i,j;+ u% l' D( W9 P- s; z
- for(i=0;i<time;i++)
" {3 _) _' }& |1 A* ^" x/ Q - for(j=0;j<9;j++);
3 r6 V5 d: D. R! B - }
复制代码 6 I$ B0 ]) g5 R
但是关于USART的函数我就不往上写了,这个简单的串口打印大家应该都会写。下面简单贴一下我的主函数吧。 - /*
" d/ ~5 R$ ^6 U3 ~/ y4 W - 教训:实验前一定要检查引脚连接是否正确,万不可搞错,不然又要烧坏芯片!!!!
9 I# u7 u( h1 z, l6 B8 J5 k" k
2 N% ]0 ~7 T2 m& _! A; Q- *// b1 A5 l+ v& A2 ^
5 J% d4 L1 }: g- #include "hcsr04.h"' [0 i2 ?& I4 f& U; U5 o
- #include "chao_usart.h"
% G* a# j. F! X4 e3 V0 [ - 3 H0 {' T0 Z- i2 {2 `8 Y
- int main()0 W! M# J( T# s' E
- {
& I$ {$ q5 H/ v8 a - # a- S4 j0 B6 u; Y- J. k
- float length;
5 w% g% I. g- U0 K! B# c' ?0 N. V -
1 X+ K/ o8 i# _# ?7 q6 }+ Q - GPIO_cfg();5 `- v2 m' Y0 ?# P$ `7 p J, F
- NVIC_cfg();# Z) @8 }' X( u7 \$ |/ i
- USART_cfg();
7 n7 N: y' m) U. ~6 J - printf("串口初始化成功!\n");
7 I6 @3 _6 R# P7 S, q9 l2 l6 Z - / K. @3 n+ m" {3 S0 X: |
- Hcsr04Init();
8 G4 k2 |% ^7 t - printf("超声波初始化成功!\n");//测试程序是否卡在下面两句上面8 H9 h R6 C" Z
1 t& \! `# @3 P. S& X- length = Hcsr04GetLength();8 f, ]8 Z \7 \8 h0 s5 c
- printf("距离为:%.3f\n",length);
1 S; V' c7 ?, r+ X! V, ^- v! w7 O- V -
" A4 K( B) d8 X# r' S y& G0 L( J! Y -
- @7 L I3 j2 h e9 m8 v - }
复制代码 1 ?: X$ V1 _0 A: p$ l! m
4 S# o( p6 X$ j/ o, s
实验结果: 7 b" e" ]2 D. j h ^$ Y0 x
+ B% s% n; L" D7 |# M7 T, ^& m
3 j& j4 W9 k! M& M1 W- s+ _
好了,其实这个模块很简单,但是要是把他用的很好的话还是比较困难的,比如用超声波做一个四轴定高的程序,还是有一定的挑战性的。 写这篇博客的目的不仅仅是介绍这个模块的使用,其实这种使用介绍网上一搜一大把,我只是想纪录一下,我在做这个模块的时候遇到的一些其他的问题。 其中有一个小插曲,就是当吧写好的程序烧进去之后,运行时总是出现每次返回一个同样的比正常值小的多的数据,比如说0.034cm,这明显是一个错误的数据,但是刚开始的时候,不知道为什么 总是这样,多次复位从新上电总是这一个数据。让我很是苦恼。但是幸运的是,在这样的情况中间,他又会有时出现一两个正常的的数据,让你有点摸不着头脑。 上网查了一下才慢慢明白,这种现象叫做“余震”,网上关于余震的解释大致有三种: 1、探头的余震。即使是分体式的,发射头工作完后还会继续震一会,这是物理效应,也就是余震。这个余震信号也会向外传播。如果你的设计是发射完毕后立刻切换为接收状态(无盲区),那么这个余震波会通过壳体和周围的空气,直接到达接收头、干扰了检测(注:通常的测距设计里,发射头和接收头的距离很近,在这么短的距离里超声波的检测角度是很大的,可达180度)。. K5 y) z/ z4 F* s" _ `5 F
2、壳体的余震。就像敲钟一样,能量仍来自发射头。发射结束后,壳体的余震会直接传导到接收头,当然这个时间很短,但已形成了干扰。另外,在不同的环境温度下,壳体的硬度和外形会有所变化,其余震有时长、有时短、有时干扰大、有时干扰小,这是设计工业级产品时必须要考虑的问题。, r: S4 I. b, U3 {, X
3、电路串扰。超声波发射时的瞬间电流很大,例如某种工业级连续测距产品瞬间电流会有15A,通常的产品也能达到1A,瞬间这么大的电流会对电源有一定影响,并干扰接收电路。通过改善电源设计可以缓解这种情况,但在低成本设计中很难根除。所以每次发射完毕,接收电路还需要一段时间稳定工作状态。在此期间,其输出的信号很难使用。 : C* c3 a3 [4 m, w
消除上述现象的方法之一就是在检测的时候多次循环检测,取平均值,也就是加权平均滤波,一个简单的滤波处理。就是下面这一段: - int i = 0;$ ]0 W4 x% u; I+ z: f
- float lengthTemp = 0;8 I8 C7 v* U) C% Q$ o$ m
- float sum = 0;- `3 W" q! @- p' N. A) q
- while(i!=5)6 e- {" @0 i; B6 z
- {! {. {9 c7 n. ^8 H. Z& Z
- TRIG_Send = 1; //发送口高电平输出
4 X5 \( |/ d3 H+ Y - Delay_Us(20);8 {+ y9 h/ q9 q/ }
- TRIG_Send = 0;. n7 k# L& Z/ V
- while(ECHO_Reci == 0); //等待接收口高电平输出. H7 n+ o% s, K) f6 p1 k1 @
- OpenTimerForHc(); //打开定时器
# b/ B' j: B6 w9 F% i% H( r& u - i = i + 1;
5 Z" M. M$ |6 R+ k+ ~ Z+ u - while(ECHO_Reci == 1);1 E; F' U. e( h. [
- CloseTimerForHc(); //关闭定时器
# ?' k5 M$ J; s2 c' D5 W& e - t = GetEchoTimer(); //获取时间,分辨率为1US
' g* u. |2 Z) r% r3 { - lengthTemp = ((float)t/58.0);//cm( t4 w& t5 t5 W/ ~3 o& U. Y9 _
- sum = lengthTemp + sum ;& C E' a/ e Z5 j0 |7 k( S
-
: L& V8 u! Z. z; f# w - }
7 A' y% V0 d x/ p8 P' k - lengthTemp = sum/5.0;& i3 h! o, C7 ~; g7 g8 P
- return lengthTemp;
复制代码 0 L5 Y# h" Z) f' |# x+ N7 i
' s* [" j1 }3 @/ @, W }加了这个之后,基本上就没有出现余震现象了。 还有一点就是测试程序前一定要检查引脚有没有接错,不管多有把握,也要看一遍,不然很容易出大事的,一个芯片也许就因为你的大意给GG了。切记,这个应该也算我们这个行业的基本素养吧。 7 m8 g: A" o0 S
|