感谢社区举办的年中粉丝节活动,倒腾出来个测距模块,刚好拿来参加一下。
9 E! s( w# A0 Y4 d. U: W" [+ o) R0 AHC-SR04超声波测距模块可提供2cm到400cm的非接触式距离感测功能,测距精度可达3mm。. G6 p0 @6 y# G. f
" H3 M6 X6 L/ P" U' M3 S6 Y一、基本工作原理
; C3 j$ s. V1 l, S1给TRIG引脚至少10us的高电平信号触发测距。/ D) j; w/ D/ T0 {$ s% X' a
2模块自动发送8个40KHz的方波,自动检测是否有信号返回5 j0 |8 ]& c! i! V, `) I: I0 E
3有信号返回,通过Echo引脚输出一个高电平,高电平的持续时间就是超声波从发射到返回的时间。9 J8 `0 m/ M7 F k" T; U9 z
4测量距离 = (高电平的持续时间 * 声速(340m/s))/ 2。
5 H9 q/ P* _( q% d, T: Q" [" I7 v, x u# E5 l2 e
二、接线
* r' w! S# c w5 s/ k
, E0 o a# k3 V$ w5 U1 w ^7 H三、模块时序图
0 t6 n+ Z3 \) P& v# J
! m. e; f7 \+ k
! W8 q* P4 S$ K$ z0 b6 ~$ N X四、驱动程序2 @; I j' ~" n; j. \7 Q
在了解了上述内容后,我们便可以根据上述知识便可以编写驱动程序了。触发信号Trig很简单直接通过IO输出和延时给一个大于10us的高电平即可触发。Echo引脚需要接收并记录高电平的持续时间,大致有3种实现的思路:
' t% Y! P# e; B
. o4 l8 v; i- C) B(1)在发送触发信号后一直等待Echo引脚的响应(变为高电平)并打开定时器计时直到Echo变为低电平,关闭定时器记录下计时时间。
$ P& k$ z( c, h: A! Q" p
4 H r6 n8 n! V5 M# A(2)在发送触发信号后,Echo响应后(上升沿)触发外部中断,开启定时器计时直到Echo变为低电平,关闭定时器记录下计时时间。' F# `0 @( A% E" ^9 S
: I' ]& ^6 z1 H* g. v& _/ F. f
(3)在发送触发信号后,通过定时器的输入捕获引脚抓取Echo引脚上升沿,开启定时器计时直到Echo变为低电平,关闭定时器记录下计时时间。
/ A- P$ N# Q B5 P! V9 J& h( t$ @8 C, T
第一种方式完全在主进程中完成,比较占用主进程资源,比较适合于超声波模块的测试应用。第二种和第三种方式在主进程中发送触发信号中断中处理接收计算距离比较适合于实际项目的应用。
/ d$ y) i7 L6 l9 U8 \# [" A
/ N) B2 S5 U" Z/ Q4 G5 ] 下面为第二种方式的驱动程序:
; U& _' t- E# O# ~- #ifndef __HC_SR04_H& m; {$ |) n, t" T" _" x3 R
- #define __HC_SR04_H! ]6 n" i. |. e+ S
- #include "stm32f10x.h"
3 S) [2 E' M& C4 E% d -
`' {. g, H3 _! v, J8 f - #define HC_SR04_TRIG_CLK RCC_APB2Periph_GPIOA: W. Q. t7 F% c3 W7 b
- #define HC_SR04_TRIG_PORT GPIOA5 G$ y y5 h' e& n/ s
- #define HC_SR04_TRIG_PIN GPIO_Pin_4
, ^' M# H1 ~+ @, n2 O/ U/ o& \$ f -
4 V1 \1 M; i6 M- a) W/ U! o - #define HC_SR04_ECHO_CLK RCC_APB2Periph_GPIOA
3 L, q$ X" F/ d% Z5 A3 a4 H; V - #define HC_SR04_ECHO_PORT GPIOA& F$ z* Y+ O% Q3 j
- #define HC_SR04_ECHO_PIN GPIO_Pin_5
! k: W! A" \# ~ -
5 v2 h. W& J' R - #define HC_SR04_ECHO_EXTI_PORT_SOURCE GPIO_PortSourceGPIOA0 M: }( b9 C; r5 M, a
- #define HC_SR04_ECHO_EXTI_PIN_SOURCE GPIO_PinSource5
' L! m! z4 Q8 W6 ~# Z -
7 T/ |/ z$ P. V8 e+ w - extern float Distance;
7 z4 f# ] U. V; ?* H: s$ u - void HC_SR04_init(void);
( v$ d1 s4 L" n1 s7 ] - void HC_SR04_start(void);
% r% e* V$ E! Y
1 n+ x! k* S2 e& t1 {2 m8 r/ S- #endif /* __HC_SR04_H*/$ j y& }& X' h* k5 g; W
复制代码
, L# f; j4 L h, g- #include "jsn-sr04t.h"
2 ~3 E! g6 @( _- P4 e; I - #include "delay.h"8 l/ i& N9 P6 ?; z' A) v
- #include "usart.h"4 E2 V3 y" C* F6 l0 d* j+ o6 ]
- #include "timer.h"
" o% R3 B. B" u7 ], o, C - 4 O$ I5 d3 G2 z8 ~5 l8 c3 m
- float Distance;
) T* g% V6 J( ^' I; I8 O8 S& A2 h8 U - . P# r' ^5 [ F9 j1 d
- * F5 p2 U: s+ S
-
- |( K% J1 [: Q - void HC_SR04_init(void)) J$ T3 a: Y; j# L
- {
; l- P) P+ |. v J; T - GPIO_InitTypeDef GPIO_InitStructure;
3 e& Q1 I9 y, Z$ q" e - EXTI_InitTypeDef EXTI_InitStructure;) ~1 c2 I0 N; Z* }' T9 B* A4 ~5 W0 `
- NVIC_InitTypeDef NVIC_InitStructure;
8 @3 B0 i/ g5 ~7 X - 4 G1 O% ^$ w/ [( c, F0 F; w
- RCC_APB2PeriphClockCmd(HC_SR04_TRIG_CLK, ENABLE); //使能PC端口时钟
! L, U: H$ R* [7 q1 Y - RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);//外部中断,需要使能AFIO时钟
+ W4 H9 b5 W, A- A) f -
" E5 o7 v! x1 D - GPIO_InitStructure.GPIO_Pin = HC_SR04_TRIG_PIN; // 脉冲触发端口(Trig)配置
) `# f; k' H/ ?8 d, _: E& m6 \ - GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽输出6 P* Y+ m. n: l6 X$ ^
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; //IO口速度为50MHz, j+ K. F, j( q( s9 Q0 R9 c
- GPIO_Init(HC_SR04_TRIG_PORT, &GPIO_InitStructure); //根据设定参数初始化端口3 U3 d# r8 l v" t
- //GPIO_ResetBits(HC_SR04_TRIG_PORT,HC_SR04_TRIG_PIN); //端口初始化为低电平
3 P3 ~, v. }4 O - $ V5 t# J' \/ D
- GPIO_InitStructure.GPIO_Pin = HC_SR04_ECHO_PIN; // 回波接收端口(Echo)配置8 a" k2 w: s2 O6 ~/ k( m
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; //上拉输入
$ w, r1 [, Q0 B3 [$ g - GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; //IO口速度为50MHz$ Q! F" q+ z6 E3 I [$ ?
- GPIO_Init(HC_SR04_ECHO_PORT, &GPIO_InitStructure); //根据设定参数初始化端口
& m8 U' r7 p# W, m! ? d2 e/ u - % o0 Y# O3 l2 m0 I
-
4 |) g! k* H% V - //接收端口 中断线以及中断初始化配置$ C- a& h% }# ?# _7 j# t: u0 i5 a
- GPIO_EXTILineConfig(GPIO_PortSourceGPIOA,GPIO_PinSource5);* t$ [% e! F9 n" w9 d$ J" F* q. W
-
# T1 n( }3 h# k# C4 c3 U6 B - EXTI_InitStructure.EXTI_Line=EXTI_Line5;
& K: C1 F7 _" b, w% z - EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt; ( A( g9 Q7 o2 Z, E ?. v1 s" \
- EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising;//上升沿触发
) ~. f3 _9 u7 [" |* X7 c) r - EXTI_InitStructure.EXTI_LineCmd = ENABLE;! x% T- ]. C: i* z3 P# z1 z: D
- EXTI_Init(&EXTI_InitStructure); //根据EXTI_InitStruct中指定的参数初始化外设EXTI寄存器! A' N% O0 h$ v+ z ?- o
-
9 x0 j& i: `" ]1 J - NVIC_InitStructure.NVIC_IRQChannel = EXTI9_5_IRQn; //使能按键所在的外部中断通道
$ ^6 y7 P$ T' g% R) b& ^& ]. n - NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0x02; //抢占优先级2, ' }$ |2 g; U& i' K# s2 d- x0 Y* x
- NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0x01; //子优先级13 v w% c7 q/ K4 v2 g6 R
- NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能外部中断通道
) t! S* o) m. q v% c - NVIC_Init(&NVIC_InitStructure);
! p5 @( q) T) H" x4 \ -
! X! i* j- _7 S8 p - TIM3_Int_Init(49999,7199); //初始化TIM3定时器,计数一次为1/10000S(0.1ms),每500ms触发一次定时中断
. h0 o0 C! {6 s2 t) o) U - //TIM_Cmd(TIM3,DISABLE);
- _$ t: W6 a& W8 B1 ^ - }
% e! J' ^0 {) f( j - % G M% V4 o+ B
- //发送20us的脉冲触发信号
) K" d% a. w& Y6 R - void HC_SR04_start(void)8 w, j% [& @7 M8 ^" j
- {3 l3 c& |# U, ^$ a1 C- q5 y
- GPIO_SetBits(HC_SR04_TRIG_PORT,HC_SR04_TRIG_PIN);
; D' a# e! \" Q5 E - delay_us(20);
j1 B* F: A E: ] - GPIO_ResetBits(HC_SR04_TRIG_PORT,HC_SR04_TRIG_PIN);; y! u V3 F; s' f1 y. r4 W
- delay_ms(10);3 Y7 P* l4 x3 e$ N
- }% W. y: d! p& @% }) o
- void EXTI9_5_IRQHandler(void)
. n3 d! w1 C5 R - {
7 h8 Y# p; Z0 k. t% q6 N - delay_us(10);
: ~9 {1 B- `/ O" v -
4 a- I* a! M. o8 d/ i; l7 I - if(EXTI_GetITStatus(EXTI_Line5) != RESET)
3 `$ b i0 F- O3 m& l - {
' U( L8 q1 t5 W7 u$ S# m - //while(GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_5) == RESET);
0 m' k% w% W3 W - TIM_SetCounter(TIM3,0); //计数清零0 b- q4 n% R( A) w: j
- TIM_Cmd(TIM3,ENABLE); //使能TIM3定时器 T6 Y; {2 h' ]& Z# [* S
-
8 P' T! y- U8 A. R% s) w. J - while(GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_5)); //等待电平变为低电平
8 B2 G5 k% o/ a5 z -
( w; B' y, ~; w - TIM_Cmd(TIM3,DISABLE); //关闭定时器
1 E- r% J- {$ ^ M5 |8 v8 g5 y+ T -
$ o. y$ F. G. N. w& L7 ~ - Distance = TIM_GetCounter(TIM3)*340/200.0; //计算距离:cnt * 1/10000 * 340 / 2(单位:m)
8 P4 V/ ^; T4 ?5 x* D' A0 Z9 D - # @% u2 m4 @7 r \2 n# V
- //printf("Counter:%d\n",TIM_GetCounter(TIM3));
% H3 v6 [# K9 N& W* Y2 w( Q% y - printf("Distance:%f cm\r\n",Distance);
! K0 e* m1 d9 {, ? - 1 ?$ s. @$ b+ K, }/ R* y4 }0 r. E
- EXTI_ClearITPendingBit(EXTI_Line5);! e! J W, E2 i/ P3 y8 n! _8 Y2 m' R0 z
- } , W7 G0 a# Q8 l7 p& t+ [( v
- }6 c1 K. f# p% h7 `( K8 D+ b5 T) F
复制代码 展示:
7 X2 @+ N x p5 E' U. M5 @ H1 C p# i3 h+ s* I1 c. G
6 d' P6 j# `; K7 }/ t. T3 N5 X8 w3 ]: I/ U7 F9 }/ T+ |
9 y) N; k9 ~& O. v
: J- X9 F$ \, l* X8 ^) b) Y
4 J% P# h+ p% U4 e* \# S0 E |