新手入门
- 积分
- 7
- 金钱
- 7
- 注册时间
- 2019-5-16
- 在线时间
- 1 小时
|
2金钱
/******************** (C) 1209 Lab **************************
* 文件名 : UltrasonicWave.c
* 描述 :超声波测距模块,UltrasonicWave_Configuration()函数
初始化超声模块,UltrasonicWave_StartMeasure()函数
启动测距,并将测得的数据通过串口1打印出来
* 实验平台:Mini STM32开发板 STM32F103RBT6
* 硬件连接:------------------
* | PC8 - TRIG |
* | PC7 - ECHO |
* ------------------
* 库版本 :ST3.5.0
*
* 作者 :Lee
*********************************************************************************/
#include "UltrasonicWave.h"
#include "usart.h"
#include "timer.h"
#include "delay.h"
#define TRIG_PORT GPIOC //TRIG
#define ECHO_PORT GPIOC //ECHO
#define TRIG_PIN1 GPIO_Pin_8 //TRIG1
#define ECHO_PIN1 GPIO_Pin_7 //ECHO1
#define TRIG_PIN2 GPIO_Pin_6 //TRIG2
#define ECHO_PIN2 GPIO_Pin_5 //ECHO2
float d;
float e;
float UltrasonicWave_Distance1; //计算出的距离
float UltrasonicWave_Distance2; //计算出的距离
void UltrasonicWave_Configuration(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
EXTI_InitTypeDef EXTI_InitStructure;
NVIC_InitTypeDef NVIC_InitStructure;
GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable , ENABLE); //关闭jtag
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC|RCC_APB2Periph_AFIO, ENABLE);
GPIO_InitStructure.GPIO_Pin = TRIG_PIN1 | TRIG_PIN2; //PC8接TRIG
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //设为推挽输出模式
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(TRIG_PORT,&GPIO_InitStructure); //初始化外设GPIO
GPIO_InitStructure.GPIO_Pin = ECHO_PIN1 | ECHO_PIN2; //PC7接ECH0
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; //设为输入
GPIO_Init(ECHO_PORT,&GPIO_InitStructure); //初始化GPIOC
//GPIOC.7 中断线以及中断初始化配置
GPIO_EXTILineConfig(GPIO_PortSourceGPIOC,GPIO_PinSource7);
EXTI_InitStructure.EXTI_Line=EXTI_Line7;
EXTI_InitStructure.EXTI_Mode=EXTI_Mode_Interrupt;
EXTI_InitStructure.EXTI_Trigger=EXTI_Trigger_Rising;
EXTI_InitStructure.EXTI_LineCmd=ENABLE;
EXTI_Init(&EXTI_InitStructure); //根据EXTI_InitStruct中指定的参数初始化外设EXTI寄存器
GPIO_EXTILineConfig(GPIO_PortSourceGPIOC,GPIO_PinSource5);
EXTI_InitStructure.EXTI_Line=EXTI_Line5;
EXTI_InitStructure.EXTI_Mode=EXTI_Mode_Interrupt;
EXTI_InitStructure.EXTI_Trigger=EXTI_Trigger_Rising;
EXTI_InitStructure.EXTI_LineCmd=ENABLE;
EXTI_Init(&EXTI_InitStructure); //根据EXTI_InitStruct中指定的参数初始化外设EXTI寄存器
NVIC_InitStructure.NVIC_IRQChannel = EXTI9_5_IRQn; //使能按键所在的外部中断通道
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2; //抢占优先级2
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 2; //子优先级2
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能外部中断通道
NVIC_Init(&NVIC_InitStructure); //根据NVIC_InitStruct中指定的参数初始化外设NVIC寄存器
}
void EXTI9_5_IRQHandler(void)
{
delay_us(10); //延时10us
if(EXTI_GetITStatus(EXTI_Line7) != RESET)
{
TIM_SetCounter(TIM2,0);
TIM_Cmd(TIM2, ENABLE); //开启时钟
while(GPIO_ReadInputDataBit(ECHO_PORT,ECHO_PIN1)); //等待低电平
TIM_Cmd(TIM2, DISABLE); //定时器2失能
UltrasonicWave_Distance1=TIM_GetCounter(TIM2)*5*34/200.0; //计算距离&&UltrasonicWave_Distance<150
if(UltrasonicWave_Distance1>0 && UltrasonicWave_Distance1<100)
{
d=UltrasonicWave_Distance1;
printf("distance1:%f cm\r\n",UltrasonicWave_Distance1);
}
EXTI_ClearITPendingBit(EXTI_Line7); //清除EXTI7线路挂起位
}
if(EXTI_GetITStatus(EXTI_Line5) != RESET)
{
TIM_SetCounter(TIM3,0);
TIM_Cmd(TIM3, ENABLE); //开启时钟
while(GPIO_ReadInputDataBit(ECHO_PORT,ECHO_PIN2)); //等待低电平
TIM_Cmd(TIM3, DISABLE); //定时器2失能
UltrasonicWave_Distance2=TIM_GetCounter(TIM3)*5*34/200.0; //计算距离&&UltrasonicWave_Distance<150
if(UltrasonicWave_Distance2>0&&UltrasonicWave_Distance2<100)
{
e=UltrasonicWave_Distance2;
printf("distance2:%f cm",UltrasonicWave_Distance2);
}
EXTI_ClearITPendingBit(EXTI_Line5); //清除EXTI7线路挂起位
}
}
void UltrasonicWave_StartMeasure(void)
{
GPIO_SetBits(TRIG_PORT,TRIG_PIN1); //送>10US的高电平RIG_PORT,TRIG_PIN这两个在define中有?
GPIO_SetBits(TRIG_PORT,TRIG_PIN2);
delay_us(20); //延时20US
GPIO_ResetBits(TRIG_PORT,TRIG_PIN1);
GPIO_ResetBits(TRIG_PORT,TRIG_PIN2);
}
|
|