|
首先,先来看一下这个模块的基本功能和原理。 HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能,测距精度可达高到3mm;模块包括超声波发射器、接收器与控制电路。像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。 注意是5v输入,但是我用stm32 的3.3v输入也是没有问题的。 6 {" u& S% M; b5 u; j( @7 x
, r# z% ]6 `0 b* }/ F1 u
二.工作原理 1.给超声波模块接入电源和地。
4 C+ Q; p" M2 B3 S# G( a 2.给脉冲触发引脚(trig)输入一个长为20us的高电平方波 3.输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;(此时应该启动定时器计时)
- B, r2 J D, m. B* k8 y, C 4.当超声波返回被模块接收到时,回波引 脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长。. d( q6 ?8 w- g5 _( o
5.根据声音在空气中的速度为344米/秒,即可计算出所测的距离。 要学习和应用传感器,学会看懂传感器的时序图是很关键的,所以我们来看一下HC-SR04的时序触发图。
1 |3 @) @6 X! ^9 v; r& t& d 我们来分析一下这个时序图,先由触发信号启动HC-RS04测距模块,也就是说,主机要先发送至少10us的高电平,触发HC-RS04,模块内部发出信号是传感器自动回应的,我们不用去管它。输出回响信号是我们需要关注的。信号输出的高电平就是超声波发出到重新返回接收所用的时间。用定时器,可以把这段时间记录下来,算出距离,别忘了结果要除于2,因为总时间是发送和接收的时间总和。 下面是亲测可用的驱动程序。 芯片型号为stm32f103zet6,超声波测距后通过串口打印到电脑上面。 驱动和测距; - //超声波测距8 p5 A) z9 z5 L# G8 e
h" t! ^' T, o3 ]: R) G- #include "hcsr04.h"5 s" y# g9 _/ [: [ m3 K" \
-
# q0 m5 {/ V O% u) e - #define HCSR04_PORT GPIOB
+ M- e& z& n' x! h2 o0 l - #define HCSR04_CLK RCC_APB2Periph_GPIOB0 U: v B6 S3 \# j- T! [: v
- #define HCSR04_TRIG GPIO_Pin_5
3 e1 Z8 `. }4 k! e# P$ x8 [ - #define HCSR04_ECHO GPIO_Pin_6' r+ p" t7 J# _2 q. `9 m
- 7 _% f0 v2 F/ F C1 @" q! ]
- #define TRIG_Send PBout(5) 9 Y. B1 Q' q+ _* c: s
- #define ECHO_Reci PBin(6)1 v6 N' C6 \; v
4 ] L) ^3 p: ]3 \* ~3 s1 J- u16 msHcCount = 0;//ms计数
/ ^: i9 ?; s8 S8 f5 M# j - u" m5 O! i5 u0 K$ G% v
- void Hcsr04Init()
; I @! X! C/ c) b - {
8 g' q3 H; R, u0 G! \ - TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; //生成用于定时器设置的结构体3 C& B( [5 e+ b% Q* K. w/ d
- GPIO_InitTypeDef GPIO_InitStructure;
; x4 R I3 j6 G) m8 C" k - RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);
: t t9 l8 [% ], x3 E -
$ y6 }; ^4 _/ m! Z- K. ?% g7 ] - //IO初始化% _, e" N: Z, u4 {
- GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG; //发送电平引脚4 N9 z2 G$ o) k# j! l% K( D) k/ i
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
4 Z5 E) ^. Y0 V$ c) k X5 a$ z - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出
7 ^* V3 o# z* a - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);8 h% I7 B$ W( x! y6 q
- GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);
, Y; J7 W' S, i" g5 u9 l -
. h [: e! z/ A! \7 ~ - GPIO_InitStructure.GPIO_Pin = HCSR04_ECHO; //返回电平引脚
" H2 ]) w9 I- R) A+ I7 P# c - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;//浮空输入
& w- S+ }) d, X) k" |7 b& V - GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);
9 V1 |/ i2 w2 m7 Q. M; Q - GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO); / C& t' F$ Q5 k; n5 G* u
- / o- G$ H4 ^, O; c, C
- //定时器初始化 使用基本定时器TIM66 z2 p" v. C/ V! h3 _1 B6 L. ^
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //使能对应RCC时钟- j; N( ^' j j
- //配置定时器基础结构体' l M) |' g3 M
- TIM_DeInit(TIM2);
& P( _5 H' y+ q/ m1 E - TIM_TimeBaseStructure.TIM_Period = (1000-1); //设置在下一个更新事件装入活动的自动重装载寄存器周期的值 计数到1000为1ms- Y2 C& l& B4 c
- TIM_TimeBaseStructure.TIM_Prescaler =(72-1); //设置用来作为TIMx时钟频率除数的预分频值 1M的计数频率 1US计数
, y& B7 w* Q7 b; a4 T S# Z3 N" p) K - TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;//不分频
0 R7 M5 W/ j9 Q3 J" T - TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式
6 F9 {9 Q! E4 Z6 x3 a& t5 {& T( r - TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位 # b) q$ K% V4 r C0 S' |
- / m' @1 g/ k# {) Z! u! R
- TIM_ClearFlag(TIM6, TIM_FLAG_Update); //清除更新中断,免得一打开中断立即产生中断& [+ C1 w, `! D, k1 b
- TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE); //打开定时器更新中断 P; L" r# c: W+ y
- hcsr04_NVIC();. I- `- ]# [( J
- TIM_Cmd(TIM6,DISABLE);
, i) u' @$ i% o0 q* \2 W - }" {7 E' U1 ?4 f6 H# u
2 j7 W( p8 M; F9 i0 V) b0 z- ~) P s/ e. J% O) B
- //tips:static函数的作用域仅限于定义它的源文件内,所以不需要在头文件里声明0 r4 K* E8 c( K1 R
- static void OpenTimerForHc() //打开定时器6 t7 e* N8 f" R8 u; Z" T
- {
" c( m7 r7 o, } - TIM_SetCounter(TIM6,0);//清除计数" V0 e, n% x7 \& x) {
- msHcCount = 0;
! A- t5 ~! ~ q" k; O6 y, p - TIM_Cmd(TIM6, ENABLE); //使能TIMx外设, q! \% c# Z A+ I2 l9 S4 }! u5 g
- } r# Z, i8 u3 g/ y. h4 n
-
# O f5 B, J3 L' f9 `& O - static void CloseTimerForHc() //关闭定时器
( ^0 B& k" V4 e - {
% M% B0 g( r) S0 V% A6 M - TIM_Cmd(TIM6, DISABLE); //使能TIMx外设
1 N- ^) n$ i$ X; I8 _" D7 t" L - }
* B5 u- M% ?( L* c& ~- J/ c - " k3 W2 }- f/ ~, L
- 7 ]# R& o9 o' |: j% i: [. C" V [; ]
- //NVIC配置
/ T# S+ j8 G. N: p - void hcsr04_NVIC()- }# [' k8 `+ u3 F3 j* k
- {
X" t' P5 t0 H - NVIC_InitTypeDef NVIC_InitStructure;# K9 ~) Z2 @+ x0 m' k0 g
- NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
- o* F& c% _$ Z5 n6 {, R' N -
3 Y) t6 `% B S0 I ? - NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn; //选择串口1中断
6 S7 C( B* Q1 |6 G; O - NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占式中断优先级设置为1, ^9 ~, ~# p7 i. w9 n+ a
- NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //响应式中断优先级设置为1
- t4 i: S( l" A0 p# H - NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能中断/ P |8 h6 {0 A6 c$ ^* }& ^- v; e1 I
- NVIC_Init(&NVIC_InitStructure);
+ _5 B: V K1 E - }7 g: g3 I# m H2 Q8 ]
$ d {. z$ N' n4 y/ x& ~
1 ~9 R: O7 E6 ~% Y2 d/ T9 m$ X- //定时器6中断服务程序: P# Z! u+ X8 X1 G6 ^. h
- void TIM6_IRQHandler(void) //TIM3中断' y' w$ g% U2 {5 x7 H. i* |
- {
9 F% {; J4 ?$ J' K& O! h - if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET) //检查TIM3更新中断发生与否
5 ?! w3 r( K- x) _- r - {# F9 c' U& a0 S! V) Q: X
- TIM_ClearITPendingBit(TIM6, TIM_IT_Update ); //清除TIMx更新中断标志
# @% {6 L9 t) `/ B" w4 a1 i - msHcCount++;( G) ^. ^' a- Z8 z) w& D8 G4 N
- }. N, C9 G! y7 h1 x3 M
- }6 t; o8 F& [. U8 Q8 `2 U! Q
- , D- `" Y. j# O* h
- + S1 g4 e) h3 Z# o
- //获取定时器时间2 ]% i8 K' D1 X1 f2 b: @
- u32 GetEchoTimer(void)
" n3 O: k& _, m7 ]' } - {
. Y, {, a4 ^( \: B0 y6 R0 f - u32 t = 0;
7 r; x6 l0 ^ h/ s _3 \5 ]; q" P" I - t = msHcCount*1000;//得到MS! t. r1 g, i K* B: x" Z( r' ]/ T
- t += TIM_GetCounter(TIM6);//得到US, \( F4 N- W" L7 V, I4 h9 C
- TIM6->CNT = 0; //将TIM2计数寄存器的计数值清零1 }% s( O$ S, M# A% w0 t
- Delay_Ms(50);
! L- h7 w5 U, R9 J - return t;
2 I. N, f+ ~1 r6 ]8 }0 P0 ? - }
: u x I/ I1 @7 H -
6 u$ N! k- q$ ?
8 y/ b9 V/ {" x9 U6 ~% y2 p( f- //一次获取超声波测距数据 两次测距之间需要相隔一段时间,隔断回响信号% a. q& ^/ ]" g/ f: u
- //为了消除余震的影响,取五次数据的平均值进行加权滤波。: z7 I( E7 b$ ]
- float Hcsr04GetLength(void )6 f# V" o( \: ?3 Z; m, q
- {
E: x* E/ Z7 v - u32 t = 0;' _; x( p- L2 T
- int i = 0;/ b1 S' n1 @" K
- float lengthTemp = 0;
* N S0 r+ a- L; y5 d$ j3 p n - float sum = 0;
0 I4 o. ]: S# u3 f# ]* @ - while(i!=5): C+ y* w( ]& @, m
- {2 j) ?! P) R( z7 {8 T) q: {) U5 X* [
- TRIG_Send = 1; //发送口高电平输出
7 W2 U/ c* f, {& ~7 l: E" S8 o - Delay_Us(20);
/ D" J0 P( k6 x5 L) {/ H - TRIG_Send = 0;
2 a3 W& u" S4 @0 n - while(ECHO_Reci == 0); //等待接收口高电平输出. p2 W) x. x7 S9 z! u3 v6 D2 F1 v
- OpenTimerForHc(); //打开定时器
& w! D, z8 Q i1 n4 A5 r/ t8 A' r - i = i + 1;
1 G6 C* Q" [# F; } - while(ECHO_Reci == 1);4 b$ \( @9 i8 x
- CloseTimerForHc(); //关闭定时器
4 P3 s3 e" o C' L T - t = GetEchoTimer(); //获取时间,分辨率为1US5 |1 s ?8 \6 C+ m1 O
- lengthTemp = ((float)t/58.0);//cm, C3 a4 N- i2 h
- sum = lengthTemp + sum ;$ [! C; {& a. N: P5 \) u" ? r8 V6 r
-
& C1 ?% z' H( }# ^7 e# F/ i - }" [7 U+ W) p( p: @2 y: i
- lengthTemp = sum/5.0;: ?" C- J/ |3 M, U, [
- return lengthTemp;
5 y7 Z5 Y/ c6 M/ _, { - }
$ V! O7 k! [1 d1 i8 y0 U# B% z6 b2 q G
; U4 k& d) v5 I3 g. e% ]! Q9 O
; U9 s- P8 N) w" H' n- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::, r, R7 x5 j, n8 k( U
- ** 函数名称: Delay_Ms_Ms
$ Y: g1 d: u3 j- [4 u - ** 功能描述: 延时1MS (可通过仿真来判断他的准确度) 0 q) S. J1 G4 e% X+ o# u K* m: {
- ** 参数描述:time (ms) 注意time<655357 m# i) c6 {0 n& o$ }* V
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/- @- a7 [. B+ B6 W6 o" \+ R
- void Delay_Ms(uint16_t time) //延时函数
& ?9 L: N7 U- E$ K7 k; k - { . D/ W* s' ~" j& f
- uint16_t i,j;+ D3 x Q$ m+ Z& V1 ~; H
- for(i=0;i<time;i++)$ y/ k: q/ ^/ I( T, A
- for(j=0;j<10260;j++);$ {: k+ F6 ?9 M
- } V& u* U5 T& Y9 C- h6 r$ r$ A: o: G" U
- /*:::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::+ ~. u& s: G- v. X
- ** 函数名称: Delay_Ms_Us
/ e( _7 x: J6 k( B - ** 功能描述: 延时1us (可通过仿真来判断他的准确度)
& K1 j2 T% d) D- }* B9 k - ** 参数描述:time (us) 注意time<65535 9 o- R0 S4 U) F5 Z: G" R
- :::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
" m' B7 n5 t: S; ` - void Delay_Us(uint16_t time) //延时函数
H, I# L+ a }0 z$ j# | - { 1 @ k! C( X. Y* |$ P v: X+ w
- uint16_t i,j;1 X$ o, y! h' t4 U' L1 e1 L
- for(i=0;i<time;i++)
4 K; n$ G! j; a2 x: F" \5 e' A8 q - for(j=0;j<9;j++);
8 i. d4 B' \, \4 Q2 U1 T: L - }
复制代码
4 c1 K! h% q1 x' W/ H但是关于USART的函数我就不往上写了,这个简单的串口打印大家应该都会写。下面简单贴一下我的主函数吧。 - /** ]9 `1 ~1 ^% K( U( l
- 教训:实验前一定要检查引脚连接是否正确,万不可搞错,不然又要烧坏芯片!!!!
. m# q" d; Y3 F v9 d, M - 1 ~/ J7 }0 w. v& b0 W1 j7 c) D
- */
; F* C' N) i9 U9 C* j6 `. Q - - X3 M0 L+ g1 t; u1 B9 i5 o
- #include "hcsr04.h"
; [( y- r1 F1 r5 {# Z1 S - #include "chao_usart.h"
6 o0 M$ D9 f* ~5 Z( O3 {; B - # K. ^! d* p1 _! D
- int main()9 `$ I" K4 d0 Y7 o( B
- {. A. k; ^; B" \) k9 C/ J
-
. V, H3 G1 v$ @0 J. O7 v- s2 @5 s - float length;
% F; |- R! Q; _ W- t( y -
4 n' O" V2 ]9 C4 t, h8 ^ - GPIO_cfg();& l$ {( f/ p+ a' ^
- NVIC_cfg();( w8 ?& ]1 w9 T1 E& i$ O
- USART_cfg();
! N0 |! ?0 k& T: L+ H% n2 X7 f - printf("串口初始化成功!\n");
/ F1 q1 @' ^' [$ |3 _, p - 4 {. ~/ z6 p. g3 K
- Hcsr04Init(); 8 T- {% C2 G8 N
- printf("超声波初始化成功!\n");//测试程序是否卡在下面两句上面
0 E6 `9 j' _3 u9 E. n- c6 }7 Q: ]4 i: Z
% ^6 n8 N1 R0 v- length = Hcsr04GetLength();
( ?6 j9 T9 |" w3 z5 s - printf("距离为:%.3f\n",length);
" g5 ~' h7 ~' ~, q( t6 Y - 8 k5 u+ B2 J. n! ~+ N' N" V1 i& |
-
$ @$ R2 H' g) `: q - }
复制代码 " ~# D N! c9 q8 l+ d$ p
* [: s1 k( ~6 y( A4 j
实验结果: 2 x! _( I' Q% E2 z2 k! v$ m. Y, a
$ b% @% I! j$ N/ S
2 K" `! i$ O$ \ w好了,其实这个模块很简单,但是要是把他用的很好的话还是比较困难的,比如用超声波做一个四轴定高的程序,还是有一定的挑战性的。 写这篇博客的目的不仅仅是介绍这个模块的使用,其实这种使用介绍网上一搜一大把,我只是想纪录一下,我在做这个模块的时候遇到的一些其他的问题。 其中有一个小插曲,就是当吧写好的程序烧进去之后,运行时总是出现每次返回一个同样的比正常值小的多的数据,比如说0.034cm,这明显是一个错误的数据,但是刚开始的时候,不知道为什么 总是这样,多次复位从新上电总是这一个数据。让我很是苦恼。但是幸运的是,在这样的情况中间,他又会有时出现一两个正常的的数据,让你有点摸不着头脑。 上网查了一下才慢慢明白,这种现象叫做“余震”,网上关于余震的解释大致有三种: 1、探头的余震。即使是分体式的,发射头工作完后还会继续震一会,这是物理效应,也就是余震。这个余震信号也会向外传播。如果你的设计是发射完毕后立刻切换为接收状态(无盲区),那么这个余震波会通过壳体和周围的空气,直接到达接收头、干扰了检测(注:通常的测距设计里,发射头和接收头的距离很近,在这么短的距离里超声波的检测角度是很大的,可达180度)。
! {- j1 u& M' W9 ], R7 e v 2、壳体的余震。就像敲钟一样,能量仍来自发射头。发射结束后,壳体的余震会直接传导到接收头,当然这个时间很短,但已形成了干扰。另外,在不同的环境温度下,壳体的硬度和外形会有所变化,其余震有时长、有时短、有时干扰大、有时干扰小,这是设计工业级产品时必须要考虑的问题。
/ a# ]- g2 k$ U( A 3、电路串扰。超声波发射时的瞬间电流很大,例如某种工业级连续测距产品瞬间电流会有15A,通常的产品也能达到1A,瞬间这么大的电流会对电源有一定影响,并干扰接收电路。通过改善电源设计可以缓解这种情况,但在低成本设计中很难根除。所以每次发射完毕,接收电路还需要一段时间稳定工作状态。在此期间,其输出的信号很难使用。
2 c; j3 p0 A& s# L0 A5 |% C消除上述现象的方法之一就是在检测的时候多次循环检测,取平均值,也就是加权平均滤波,一个简单的滤波处理。就是下面这一段: - int i = 0;2 A$ W; Y. w! g- s: e" S9 I
- float lengthTemp = 0;
) h5 w+ A4 h2 _) x$ X; T - float sum = 0;
( b, a0 n4 I) @% |) J+ s# L2 L, F - while(i!=5)
+ @0 R; ]5 I5 M# J - {
' C5 `# ?' f- X: I" S( z5 U- W - TRIG_Send = 1; //发送口高电平输出
9 B7 `9 ~, c X6 {4 \- `) C( q: x - Delay_Us(20);
7 _2 v4 i' G$ L3 O4 s) | - TRIG_Send = 0;
; W; ?- [: |6 `2 t8 q* K - while(ECHO_Reci == 0); //等待接收口高电平输出
- ^. y) |! `5 \- q; g: w5 ~- h6 d" S - OpenTimerForHc(); //打开定时器2 o; n9 J; g3 a
- i = i + 1;
# x) M t ?5 X# e1 r - while(ECHO_Reci == 1);
- @( F( ]4 R, F8 o1 ? - CloseTimerForHc(); //关闭定时器# e3 [) B1 K4 x$ q" U: |" y
- t = GetEchoTimer(); //获取时间,分辨率为1US# l3 a" u8 |. ~% g
- lengthTemp = ((float)t/58.0);//cm* Y: W+ |5 d, g
- sum = lengthTemp + sum ;
- X9 `* h7 J% E - * _% f& W- w" i# {8 f7 a' g: A8 p
- }) @8 u: B2 m8 d3 J @- H
- lengthTemp = sum/5.0;* ^2 {0 p, x5 S4 G
- return lengthTemp;
复制代码 D$ T6 o6 _" z5 V
2 f! T9 }+ c( L |& |' @: o$ l% z加了这个之后,基本上就没有出现余震现象了。 还有一点就是测试程序前一定要检查引脚有没有接错,不管多有把握,也要看一遍,不然很容易出大事的,一个芯片也许就因为你的大意给GG了。切记,这个应该也算我们这个行业的基本素养吧。 ( T5 t+ D! o% z, b; n& o
|