超聲波模塊程序_STM32F103ZET6 內附視頻

ID:769641 · 發(fā)表于 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);

//中斷優(yōu)先級管理
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);             //持續(xù)大于10us觸發(fā)，觸發(fā)超聲波模塊工作
GPIO_ResetBits(GPIOE,Trig);

}

帳號		自動登錄	找回密碼
密碼			立即注冊

超聲波模塊程序_STM32F103ZET6 內附視頻

評分