**
超声波测距原理
** 参考博客: https://blog.csdn.net/qq_40734815/article/details/105992801 https://blog.csdn.net/qq_43743762/article/details/103217402
利用HC-SR04超声波测距模块可以实现比较精确的直线测距,其测距原理图如下: HC-SR04的一端发出超声波,接触到反射物后反射,被另一个端口接收到,所以只要知道发射和接收的时间差,就可以根据声波传播的速率算出HC-SR04和反射物直接的距离。 所以实现超声波测距就需要俩个条件:
(1) 发射和接收的时间差
(2) 超声波传输的速率
HC-SR04工作原理
HC-SR04模块的电气参数如示:
HC-SR04模块的实物图
通过了解超声波测距原理和工作原理可以得知测距原理 (1)超声波模块的TRIG引脚给最少10us高电平信号,触发测距。 (2)模块自动发送8个40khz的方波,自动检测是否有信号返回; (3)有信号返回, 通过ECHO口输出一个高电平, 高电平持续的时间就是超声波从发射到返回的时间。 测试距离=(高电平时间*声速(340M/S))/2。 因此只要检测ECHO连接的单片机引脚高电平持续时间 便可以得到超声波从发射到返回的时间。
检测时间方法
这里使用的是定时器输入捕获功能,网上还有其他方法,参考方法在参考博客中有写到。 采用定时器的输入捕获功能,直接将ECHO引脚接到STM32具有输入捕获功能的管脚,配置好定时器输入捕获功能,就可以读取到高电平时间。
(1)超声波模块的TRIG引脚给最少10us高电平信号,触发测距。
void HCSR04_TRIG_Send(void)
{
TRIG = 1;
delay_us(20);
TRIG = 0;
}
void HCSR04_TRIG_Init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC, ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOC, &GPIO_InitStructure);
}
(2)模块自动发送8个40khz的方波,自动检测是否有信号返回;
(3)有信号返回, 通过ECHO口输出一个高电平, 高电平持续的时间就是超声波从发射到返回的时间。
float Get_Distance(void)
{
float distance = 0;u32 temp = 0;
HCSR04_TRIG_Send();
if(TIM5CH1_CAPTURE_STA&0X80)
{
temp=TIM5CH1_CAPTURE_STA&0X3F;
temp*=65536;
temp+=TIM5CH1_CAPTURE_VAL;
distance = (float)temp * 170 / 10000;
TIM5CH1_CAPTURE_STA=0;
}
return distance;
}
定时器timer.c配置
#include "timer.h"
#include "usart.h"
TIM_ICInitTypeDef TIM5_ICInitStructure;
void TIM5_Cap_Init(u16 arr,u16 psc)
{
GPIO_InitTypeDef GPIO_InitStructure;
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
NVIC_InitTypeDef NVIC_InitStructure;
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM5, ENABLE);
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD;
GPIO_Init(GPIOA, &GPIO_InitStructure);
GPIO_ResetBits(GPIOA,GPIO_Pin_0);
TIM_TimeBaseStructure.TIM_Period = arr;
TIM_TimeBaseStructure.TIM_Prescaler =psc;
TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
TIM_TimeBaseInit(TIM5, &TIM_TimeBaseStructure);
TIM5_ICInitStructure.TIM_Channel = TIM_Channel_1;
TIM5_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;
TIM5_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
TIM5_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
TIM5_ICInitStructure.TIM_ICFilter = 12;
TIM_ICInit(TIM5, &TIM5_ICInitStructure);
NVIC_InitStructure.NVIC_IRQChannel = TIM5_IRQn;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
NVIC_Init(&NVIC_InitStructure);
TIM_ITConfig(TIM5,TIM_IT_Update|TIM_IT_CC1,ENABLE);
TIM_Cmd(TIM5,ENABLE );
}
u8 TIM5CH1_CAPTURE_STA=0;
u16 TIM5CH1_CAPTURE_VAL;
void TIM5_IRQHandler(void)
{
if((TIM5CH1_CAPTURE_STA&0X80)==0)
{
if (TIM_GetITStatus(TIM5, TIM_IT_Update) != RESET)
{
if(TIM5CH1_CAPTURE_STA&0X40)
{
if((TIM5CH1_CAPTURE_STA&0X3F)==0X3F)
{
TIM5CH1_CAPTURE_STA|=0X80;
TIM5CH1_CAPTURE_VAL=0XFFFF;
}else TIM5CH1_CAPTURE_STA++;
}
}
if (TIM_GetITStatus(TIM5, TIM_IT_CC1) != RESET)
{
if(TIM5CH1_CAPTURE_STA&0X40)
{
TIM5CH1_CAPTURE_STA|=0X80;
TIM5CH1_CAPTURE_VAL=TIM_GetCapture1(TIM5);
TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Rising);
}else
{
TIM5CH1_CAPTURE_STA=0;
TIM5CH1_CAPTURE_VAL=0;
TIM_SetCounter(TIM5,0);
TIM5CH1_CAPTURE_STA|=0X40;
TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Falling);
}
}
}
TIM_ClearITPendingBit(TIM5, TIM_IT_CC1|TIM_IT_Update);
}
定时器timer.h配置
#ifndef __TIMER_H
#define __TIMER_H
#include "sys.h"
void TIM5_Cap_Init(u16 arr,u16 psc);
#endif
hcsr04.c配置
#include "hcsr04.h"
extern u8 TIM5CH1_CAPTURE_STA;
extern u16 TIM5CH1_CAPTURE_VAL;
void HCSR04_TRIG_Send(void)
{
TRIG = 1;
delay_us(20);
TRIG = 0;
}
void HCSR04_TRIG_Init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC, ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOC, &GPIO_InitStructure);
}
float Get_Distance(void)
{
float distance = 0;u32 temp = 0;
HCSR04_TRIG_Send();
if(TIM5CH1_CAPTURE_STA&0X80)
{
temp=TIM5CH1_CAPTURE_STA&0X3F;
temp*=65536;
temp+=TIM5CH1_CAPTURE_VAL;
distance = (float)temp * 170 / 10000;
TIM5CH1_CAPTURE_STA=0;
}
return distance;
}
hcsr04.h配置
#ifndef __HCSR04_H
#define __HCSR04_H
#include "sys.h"
#include "delay.h"
#define TRIG PCout(1)
void HCSR04_TRIG_Send(void);
void HCSR04_TRIG_Init(void);
float Get_Distance(void);
#endif
main.c配置
#include "delay.h"
#include "sys.h"
#include "usart.h"
#include "timer.h"
#include "hcsr04.h"
float distance = 0;
int main(void)
{
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
delay_init();
HCSR04_TRIG_Init();
uart1_init(115200);
TIM5_Cap_Init(0XFFFF,72-1);
printf("初始化成功");
while(1)
{
delay_ms(500);
distance = Get_Distance();
printf("distance: %.2f cm\r\n",distance);
}
}
其中遇到的问题:
超声波测距接线,串口打印数据为0.00cm 解决:检查接线是否存在问题,(PC1)–>TRIG,(PA0)–>ECHO,确认无误,检查stm32,超声波模块供电是否存在问题,都没问题最后检查代码是否存在问题,全部确认完了,仍然检测不出距离,最后换了杜邦线重新接线就好了。检测精度还是可以的。
|