超声波模块程序_STM32F103ZET6 内附视频

ID:769641 · 发表于 2020-6-4 21:20

include "wave.h"
#include "sys.h"
#include "delay.h"
#include "usart.h"
#define Trig GPIO_Pin_4
#define Echo GPIO_Pin_6
float Distance;
void Wave_SRD_Init(void)
{
GPIO_InitTypeDef  GPIO_InitSture;
EXTI_InitTypeDef  EXTI_InitSture;
NVIC_InitTypeDef  NVIC_InitSture;
//如果外部中断的话则一定使能AFIO复用功能
RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO|RCC_APB2Periph_GPIOE,ENABLE);

//配置IO端口
GPIO_InitSture.GPIO_Mode=GPIO_Mode_Out_PP; //推挽输出模式
GPIO_InitSture.GPIO_Pin=Trig;             //将PE4于Trig相连
GPIO_InitSture.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOE,&GPIO_InitSture);

GPIO_InitSture.GPIO_Mode=GPIO_Mode_IPD;    //拉输入模式
GPIO_InitSture.GPIO_Pin=Echo;             //将PE6于Echo相连
GPIO_InitSture.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_Init(GPIOE,&GPIO_InitSture);

//中断和6端口映射一起
GPIO_EXTILineConfig(GPIO_PortSourceGPIOE,GPIO_PinSource6);

//外部中断配置
EXTI_InitSture.EXTI_Line=EXTI_Line6;
EXTI_InitSture.EXTI_LineCmd=ENABLE;
EXTI_InitSture.EXTI_Mode=EXTI_Mode_Interrupt;
EXTI_InitSture.EXTI_Trigger=EXTI_Trigger_Rising;
EXTI_Init(&EXTI_InitSture);

//中断优先级管理
NVIC_InitSture.NVIC_IRQChannel=EXTI9_5_IRQn;
NVIC_InitSture.NVIC_IRQChannelCmd=ENABLE;
NVIC_InitSture.NVIC_IRQChannelPreemptionPriority=2;
NVIC_InitSture.NVIC_IRQChannelSubPriority=2;
NVIC_Init(&NVIC_InitSture);
}
void EXTI9_5_IRQHandler(void)
{
delay_us(10);

if(EXTI_GetITStatus(EXTI_Line6)!=RESET)
{
  TIM_SetCounter(TIM3,0);
  TIM_Cmd(TIM3,ENABLE);

  while(GPIO_ReadInputDataBit(GPIOE,Echo));  //等待低电平

  TIM_Cmd(TIM3,DISABLE);

  Distance=TIM_GetCounter(TIM3)*340/200.0;

  if(Distance>0)
  {
printf("Distance:%f cm\r\n",Distance);
  }

  EXTI_ClearITPendingBit(EXTI_Line6);
}
}
void Wave_SRD_Strat(void)
{
GPIO_SetBits(GPIOE,Trig); //将Trig设置为高电平
delay_us(20);             //持续大于10us触发，触发超声波模块工作
GPIO_ResetBits(GPIOE,Trig);

}

帐号		自动登录	找回密码
密码			立即注册

超声波模块程序_STM32F103ZET6 内附视频

评分