|
首先,先来看一下这个模块的基本功能和原理。 HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能,测距精度可达高到3mm;模块包括超声波发射器、接收器与控制电路。像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。 注意是5v输入,但是我用stm32 的3.3v输入也是没有问题的。
0 c) j4 _+ S/ t' _
- m7 m' [3 |' L* M
二.工作原理 1.给超声波模块接入电源和地。4 Y% R `3 q; g0 h
2.给脉冲触发引脚(trig)输入一个长为20us的高电平方波 3.输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;(此时应该启动定时器计时)
" o8 g5 v g/ x( _: c 4.当超声波返回被模块接收到时,回波引 脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长。
, W2 ]# ^5 t5 l% e1 q7 r 5.根据声音在空气中的速度为344米/秒,即可计算出所测的距离。 要学习和应用传感器,学会看懂传感器的时序图是很关键的,所以我们来看一下HC-SR04的时序触发图。
, ~, R* k1 A* e5 T+ g- V 我们来分析一下这个时序图,先由触发信号启动HC-RS04测距模块,也就是说,主机要先发送至少10us的高电平,触发HC-RS04,模块内部发出信号是传感器自动回应的,我们不用去管它。输出回响信号是我们需要关注的。信号输出的高电平就是超声波发出到重新返回接收所用的时间。用定时器,可以把这段时间记录下来,算出距离,别忘了结果要除于2,因为总时间是发送和接收的时间总和。 下面是亲测可用的驱动程序。 芯片型号为stm32f103zet6,超声波测距后通过串口打印到电脑上面。 驱动和测距; - //超声波测距. B& \+ D8 T5 h2 \$ I
! ^1 ^' J! ?$ t2 t- #include "hcsr04.h"' T/ Y) R9 a6 n: W' p" z" K- g3 v7 a
- , g: e2 m. E+ ^ d0 p
- #define HCSR04_PORT GPIOB
2 t+ `7 ^# r2 R" M( ?/ m/ u - #define HCSR04_CLK RCC_APB2Periph_GPIOB
9 x; O; d1 s( ~# W7 F s( ? - #define HCSR04_TRIG GPIO_Pin_5
- p' J0 } S+ Z- z2 o- r) o( }4 c - #define HCSR04_ECHO GPIO_Pin_6
; I# A! }" e( u2 g- I2 H# e - L" t: l; |5 D% X+ {* d" z
- #define TRIG_Send PBout(5)
" J/ T; j' m; G) ]2 N; I ? - #define ECHO_Reci PBin(6)) q0 z$ e7 a6 E9 O* o
! U/ z/ r& ~5 b0 v. ?+ g- X: ^" t- u16 msHcCount = 0;//ms计数
8 N3 I- J* L. W
+ Q: c9 d% f9 ^9 i7 _- void Hcsr04Init()1 o5 r) W3 Y0 X+ {) B
- { 6 K8 U6 D, J3 l* u' B, ~
- TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; //生成用于定时器设置的结构体' b- C7 r- ?8 ~/ z
- GPIO_InitTypeDef GPIO_InitStructure;# g- f# a8 w+ e }) r! g
- RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);. i5 x9 T" p1 a
-
% ]/ Q% U$ o7 h8 E7 Z( @ - //IO初始化
, f. }1 d, o/ O8 g - GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG; //发送电平引脚. ~! {$ H) q# N
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
5 X$ i# n) f8 L+ h5 c3 x - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出1 I+ Z# E {* L+ x" ?* ~
- GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);7 n7 e( q+ N0 t7 F- e2 G( A1 q
- GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);) V; O, I" `4 B8 z" s
-
2 ^( u8 |. U$ @& ] r7 B - GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO; //返回电平引脚# v& W7 r6 W) B3 u7 K E
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
- T& [* P# z( {7 i' p - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure); 4 }1 V" h3 O5 {6 ?; U
- GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO); 1 O* |4 m2 p* [! c. A) h# i
-
* G$ I ^+ i2 B, g. D, S" s5 s - //定时器初始化 使用基本定时器TIM6
. Y; t i1 J. t. W - RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //使能对应RCC时钟( v9 |' S. b! \9 O7 V* M/ ]% f* `
- //配置定时器基础结构体& ?* m! ]& O3 X: `. p: ]6 ~0 s- e
- TIM_DeInit(TIM2);
* _2 m4 S4 \' R. J O - TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值 计数到1000为1ms
; }; J7 y k% M0 ]% @% B - TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值 1M的计数频率 1US计数
* O. b8 W' R. f! e Z - TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频" g- m7 h' U* O$ _+ C% I9 f+ G& t8 p
- TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式! F, a6 M6 R' `
- TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位 ; k9 c& o; ?. G1 r: w5 n ?3 i& P
- " a+ s4 i4 p8 f0 t! g
- TIM_ClearFlag(TIM6, TIM_FLAG_Update); //清除更新中断,免得一打开中断立即产生中断$ _2 \0 X% B& D8 F
- TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); //打开定时器更新中断
7 u; N5 t$ M1 [7 D/ r - hcsr04_NVIC();
, o4 N; B" J& T& p1 h0 ~: \ - TIM_Cmd(TIM6,DISABLE); ; P) A* `$ {0 R: h* n" \0 d- z
- }, ^2 W! w( J; e3 Y! {4 H
9 R/ M5 V+ R) l) {- 4 |' Y+ W& \. `( m) l" J6 _+ ?/ V( F" j
- //tips:static函数的作用域仅限于定义它的源文件内,所以不需要在头文件里声明
& ], g/ [4 H- C - static void OpenTimerForHc() //打开定时器
% I5 K& X+ Z& B - {
- A6 g; v0 a: U1 l2 y - TIM_SetCounter(TIM6,0);//清除计数3 w# v- K0 c. j7 V5 q. ^; E8 @
- msHcCount = 0;
7 {# L4 U7 z h# H. Z - TIM_Cmd(TIM6, ENABLE); //使能TIMx外设
& O) Q# u- l7 @* \ - }$ X# l1 l& w: M# _7 N! u: O* Y
-
f" T. ?! y& n$ o - static void CloseTimerForHc() //关闭定时器
* F' O( c- D9 h4 H/ i: s4 F - {* F/ M0 S$ G* j6 b, a
- TIM_Cmd(TIM6, DISABLE); //使能TIMx外设
2 n9 v9 {) r! a, v$ Y1 [( e - }
/ L( u; @% q* P! y3 i2 R - 6 q3 i7 p# W3 V9 r, D7 }
-
5 G/ a$ F* j1 e# a' N - //NVIC配置7 ]) j1 ^1 b& W0 _
- void hcsr04_NVIC()
! t- \1 v$ X u - {
; h1 m* T% d! @; _/ S" d - NVIC_InitTypeDef NVIC_InitStructure;
# t& M4 r4 v0 @0 [) e! N - NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);- M3 ^4 Z7 U4 K* ^2 L, t: K
-
3 y9 E N; s: ]/ Y$ ?) C- X - NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn; //选择串口1中断1 s# k& u0 D' e" \1 f
- NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占式中断优先级设置为1* W& m) X/ A" s7 t$ a" h* S! }3 ?
- NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //响应式中断优先级设置为1
- w( K& w4 W& t - NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能中断
3 E3 r6 i5 l( W+ q; X) Y - NVIC_Init(&NVIC_InitStructure); g5 o& r5 U$ z
- }& `5 b8 h; L0 L1 O& e G
- P7 V% q9 }5 Y- . D% a! f, c2 ]' \6 A3 q) Z
- //定时器6中断服务程序: d! t# ], W7 h K0 U. @! p
- void TIM6_IRQHandler(void) //TIM3中断$ d8 D- H; |+ q+ O2 d" T, x
- {
8 P) b" f$ i2 j - if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET) //检查TIM3更新中断发生与否
5 f" M6 [9 n R. W0 n/ ` - {
L' M2 g$ u# ^! |5 e. w% F - TIM_ClearITPendingBit(TIM6, TIM_IT_Update ); //清除TIMx更新中断标志 % y8 X1 ~) P3 w e) V& f Y
- msHcCount++;& x; Q8 H4 E) x, M% p6 {
- }$ n& \& Y; I) ~ m/ G& ?1 N/ h0 W0 ]
- }; A4 C, Z% h; z+ M. T. C
- & ^$ Z1 z& A. m1 X8 v
- 7 r# }8 F( a5 \- G: _! Z
- //获取定时器时间. c- O$ \7 @/ a
- u32 GetEchoTimer(void)7 R/ o1 o `: Z5 y) ?) l/ ~5 _' C. D- d
- {
" m, ]% O5 g$ _6 b' z% H - u32 t = 0;, a* P- a9 ~2 K7 b+ V1 a
- t = msHcCount*1000;//得到MS/ D$ r! I, K5 h) W8 q7 _
- t += TIM_GetCounter(TIM6);//得到US
/ Q$ U, B" V1 N* s; i: M - TIM6->CNT = 0; //将TIM2计数寄存器的计数值清零
, k2 E! b5 H2 Q+ s+ k - Delay_Ms(50);% p* i, G s; P( M8 Q; R
- return t;
" r6 R# i" }( X, K% m3 s - }
% X* S1 x. F, r2 Z s8 y( I( [ -
+ J( O# j3 W5 u: R
# i8 g) V# ^; \- //一次获取超声波测距数据 两次测距之间需要相隔一段时间,隔断回响信号
* |4 n4 n3 O4 H4 z. x& J, R7 o - //为了消除余震的影响,取五次数据的平均值进行加权滤波。
7 V! Z5 `* Y2 O - float Hcsr04GetLength(void )7 K4 D- d7 J& d
- {
. D+ @7 L# R8 m( E/ v1 w! g) @ - u32 t = 0;
9 e6 Y! T' c* Y7 Y - int i = 0;
0 t5 @9 `# `( R. G, V - float lengthTemp = 0;" V& W: |4 b, _
- float sum = 0;9 d. K5 V1 Z' l- D" ?) u
- while(i!=5)3 O9 Z' y* Y# t+ y0 ~5 V
- {$ A; @2 ^' R/ C5 [) F B
- TRIG_Send = 1; //发送口高电平输出1 V- y& V+ {; f7 r# @& v1 N1 t
- Delay_Us(20);' `; D: I, J1 _" ^( ]0 {
- TRIG_Send = 0;' T; n% }5 c0 o! U* _
- while(ECHO_Reci == 0); //等待接收口高电平输出+ I4 I5 E N4 B$ t- F
- OpenTimerForHc(); //打开定时器
& |. q: [' p; h; A - i = i + 1;
0 H. F- X0 w) s9 m - while(ECHO_Reci == 1);: |, U/ f" Q8 T; F
- CloseTimerForHc(); //关闭定时器7 n7 E* N9 c$ g) b8 t" B
- t = GetEchoTimer(); //获取时间,分辨率为1US) i: o: U" G0 Z& T
- lengthTemp = ((float)t/58.0);//cm* y5 s" P8 J. z
- sum = lengthTemp + sum ;! f! ^2 a' q' [7 } S3 A: ~# h4 h
-
; `- }' i0 R; B - }
6 F9 o( g P E# k [ - lengthTemp = sum/5.0;
' {. t# x- D/ [/ i - return lengthTemp;2 V! G' J4 P! S [
- }
) o# \0 k0 m! U4 V$ ~) a$ ` - ! R/ n7 ], t( Y4 w( A' A
8 Q2 J0 Z9 Q. [! ~/ Z- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::. I. e$ ^- q. t
- ** 函数名称: Delay_Ms_Ms
7 `3 k+ q# Y" D1 d" {9 Q - ** 功能描述: 延时1MS (可通过仿真来判断他的准确度) , u1 D) I" E0 B
- ** 参数描述:time (ms) 注意time<65535: H0 |7 j, ~* y* o
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
% x) B; s: y5 u - void Delay_Ms(uint16_t time) //延时函数. k' W8 ]! i* o
- { 9 }( @( B; r+ M. |- w+ T$ O) o& I
- uint16_t i,j;: G i8 m. w. `0 F' r0 c8 v; [6 P4 `
- for(i=0;i<time;i++). D- ~% V/ s2 e8 P" W+ ]# {8 f+ {5 {
- for(j=0;j<10260;j++);3 S1 t! b7 K6 Q! I
- }
. W5 o2 r Y9 t, ] - /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::# m9 N" Y, V+ C, C+ d
- ** 函数名称: Delay_Ms_Us
9 d, Q" \+ @' F) U - ** 功能描述: 延时1us (可通过仿真来判断他的准确度)
+ p% y6 W0 s1 t8 B; Y - ** 参数描述:time (us) 注意time<65535 & V+ ]& Z2 e; {
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/ F [7 m" I) C* g
- void Delay_Us(uint16_t time) //延时函数1 q9 H/ z9 B9 k y6 F$ U6 i
- {
) V2 K, X6 @& Y5 V; H1 W- z3 } - uint16_t i,j;7 l% T9 Y2 E F J7 S0 k' R9 N7 T) e+ @
- for(i=0;i<time;i++)
2 }! d! {4 o, B x2 { - for(j=0;j<9;j++);) n8 \: f; V* |2 f9 s
- }
复制代码
! C9 A% {7 X0 L9 ^" a, d但是关于USART的函数我就不往上写了,这个简单的串口打印大家应该都会写。下面简单贴一下我的主函数吧。 - /*# x3 B/ x# J& @2 ?0 z: C: S
- 教训:实验前一定要检查引脚连接是否正确,万不可搞错,不然又要烧坏芯片!!!!
9 D- ^4 D- O! [% X) ?/ y/ {
: B' z/ K. v/ f' n- */! M) N) f' Z" J" _- _1 E8 |
- & S( Q! v7 \7 l2 P" x
- #include "hcsr04.h"( s4 l6 Q, @0 x8 J
- #include "chao_usart.h"" [" {, j* R9 @4 o9 Q, ~
: ]! c1 Y4 B8 ~4 F* s, ?- int main()! B" F. d, H# N# b& b
- {
6 i1 D" T8 _9 o- i5 L( |/ g - C3 {5 I3 P. S, I- M. d! ? c. F
- float length;4 J# P) H6 ]+ g) @' t
-
/ V! y, Q: y' L" v - GPIO_cfg();
) Z% }( a* r) D, x* c; w! u - NVIC_cfg();
! E2 c2 y$ ?1 W* H: C% o5 C - USART_cfg(); 7 y* g$ Z+ n1 ] n' B/ v
- printf("串口初始化成功!\n");: y/ r( _3 [; ~* _( o+ P$ U ?
-
+ V$ W; s+ J+ @* _1 @ - Hcsr04Init();
8 L e- ]$ y6 S# H9 P - printf("超声波初始化成功!\n");//测试程序是否卡在下面两句上面; T, F3 E2 n, B6 J5 q5 U
7 m; Q k6 ~& o. M6 |- length = Hcsr04GetLength();
1 z4 e3 [* @& t1 m - printf("距离为:%.3f\n",length);
0 l9 U) s8 `& K( y4 z; D! t+ a -
* g% z" a/ k& B - * t9 x2 z T- f# u
- }
复制代码
6 P B& V% A$ E8 b3 m' `) }. p# f- p9 N, A& O
实验结果: : ]: T8 d7 E" V
+ [) N6 Z5 P* Q0 [# w" v1 h) c( n0 @
7 }! t7 Q7 G" N好了,其实这个模块很简单,但是要是把他用的很好的话还是比较困难的,比如用超声波做一个四轴定高的程序,还是有一定的挑战性的。 写这篇博客的目的不仅仅是介绍这个模块的使用,其实这种使用介绍网上一搜一大把,我只是想纪录一下,我在做这个模块的时候遇到的一些其他的问题。 其中有一个小插曲,就是当吧写好的程序烧进去之后,运行时总是出现每次返回一个同样的比正常值小的多的数据,比如说0.034cm,这明显是一个错误的数据,但是刚开始的时候,不知道为什么 总是这样,多次复位从新上电总是这一个数据。让我很是苦恼。但是幸运的是,在这样的情况中间,他又会有时出现一两个正常的的数据,让你有点摸不着头脑。 上网查了一下才慢慢明白,这种现象叫做“余震”,网上关于余震的解释大致有三种: 1、探头的余震。即使是分体式的,发射头工作完后还会继续震一会,这是物理效应,也就是余震。这个余震信号也会向外传播。如果你的设计是发射完毕后立刻切换为接收状态(无盲区),那么这个余震波会通过壳体和周围的空气,直接到达接收头、干扰了检测(注:通常的测距设计里,发射头和接收头的距离很近,在这么短的距离里超声波的检测角度是很大的,可达180度)。
, S! a. ` a ]" m 2、壳体的余震。就像敲钟一样,能量仍来自发射头。发射结束后,壳体的余震会直接传导到接收头,当然这个时间很短,但已形成了干扰。另外,在不同的环境温度下,壳体的硬度和外形会有所变化,其余震有时长、有时短、有时干扰大、有时干扰小,这是设计工业级产品时必须要考虑的问题。, ?5 b* b/ W! s
3、电路串扰。超声波发射时的瞬间电流很大,例如某种工业级连续测距产品瞬间电流会有15A,通常的产品也能达到1A,瞬间这么大的电流会对电源有一定影响,并干扰接收电路。通过改善电源设计可以缓解这种情况,但在低成本设计中很难根除。所以每次发射完毕,接收电路还需要一段时间稳定工作状态。在此期间,其输出的信号很难使用。 T- E# H. C; I B
消除上述现象的方法之一就是在检测的时候多次循环检测,取平均值,也就是加权平均滤波,一个简单的滤波处理。就是下面这一段: - int i = 0;1 X' P$ d9 t* A2 W- ^* W
- float lengthTemp = 0;
4 p) k( ^! {8 S, K4 M' F - float sum = 0;
- b3 f# b' b& c* W8 L - while(i!=5)
, C& i+ v! K' m9 w; ~0 W - {
- ~+ V8 d& W& U0 D/ j - TRIG_Send = 1; //发送口高电平输出
5 h& X- b2 k( h" h; N3 z - Delay_Us(20);2 O s- }( |6 |9 V% ^" p
- TRIG_Send = 0;
3 K7 t" E3 W! H j- O( t - while(ECHO_Reci == 0); //等待接收口高电平输出
6 E0 K* G' I8 P8 m, z# ` - OpenTimerForHc(); //打开定时器( X0 ~. [+ E$ j% C# _
- i = i + 1;
% U# N0 L' o1 }" M - while(ECHO_Reci == 1);
' @& i2 v- T5 M) o - CloseTimerForHc(); //关闭定时器1 ]6 K! [& B3 u, Y1 b
- t = GetEchoTimer(); //获取时间,分辨率为1US
! M) V" q+ J- F( a* l0 K+ u7 i: \+ X - lengthTemp = ((float)t/58.0);//cm
- l& A( ]% i- r$ ?0 q - sum = lengthTemp + sum ;4 j% ^3 n9 N$ U1 g4 z; ^4 L
- ' v) a3 V$ D1 S- i$ |) V) ^
- }
: y2 W' _1 j+ p; z { - lengthTemp = sum/5.0;# c G, i b M" J
- return lengthTemp;
复制代码 4 m4 O3 O7 z/ Z9 b Z ?+ r
% v/ T$ s+ C/ k J4 C0 r
加了这个之后,基本上就没有出现余震现象了。 还有一点就是测试程序前一定要检查引脚有没有接错,不管多有把握,也要看一遍,不然很容易出大事的,一个芯片也许就因为你的大意给GG了。切记,这个应该也算我们这个行业的基本素养吧。 , H. M+ J/ e4 C
|