stm32使用HC-S104超声波模块

#include "stm32f10x.h"
#include "delay.h"

// 定义超声波模块引脚
#define TrigPin GPIO_Pin_6
#define EchoPin GPIO_Pin_7
#define TrigPort GPIOB
#define EchoPort GPIOB

// 定义超声波模块发射脉冲宽度
#define PULSE_WIDTH_US 10

// 计算距离的函数
float distance;
void calculate_distance(void)
{
    uint32_t i;
    float us_per_mm;

    // 发送一个10us的脉冲
    GPIO_ResetBits(TrigPort, TrigPin);
    Delay_us(PULSE_WIDTH_US);
    GPIO_SetBits(TrigPort, TrigPin);

    // 等待回波信号
    for (i = 0; i < 50000; ++i) {
        if (GPIO_ReadInputDataBit(EchoPort, EchoPin)) {
            break;
        }
    }
    if (i == 50000) {
        return;
    }

    // 计算回波信号上升沿到下降沿的时间
    TIM_SetCounter(TIM2, 0);
    while (GPIO_ReadInputDataBit(EchoPort, EchoPin)) {
        if (TIM_GetCounter(TIM2) > 50000) {
            return;
        }
    }
    us_per_mm = 1.0f / 58.0f;
    distance = TIM_GetCounter(TIM2) * us_per_mm;
}

// 主函数
int main(void)
{
    // 使能GPIOB,TIM2以及相关中断
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB | RCC_APB2Periph_AFIO, ENABLE);
    RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_SYSCFG, ENABLE);
    GPIO_PinRemapConfig(GPIO_FullRemap_TIM2, ENABLE);

    // 配置Trig和Echo引脚
    GPIO_InitTypeDef gpio;
    gpio.GPIO_Pin = TrigPin;
    gpio.GPIO_Mode = GPIO_Mode_Out_PP;
    gpio.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(TrigPort, &gpio);

    gpio.GPIO_Pin = EchoPin;
    gpio.GPIO_Mode = GPIO_Mode_IPD;
    GPIO_Init(EchoPort, &gpio);

    // 配置TIM2用于计时
    TIM_TimeBaseInitTypeDef tim;
    tim.TIM_Prescaler = 72 - 1;
    tim.TIM_Period = 0xFFFF;
    tim.TIM_ClockDivision = TIM_CKD_DIV1;
    tim.TIM_CounterMode = TIM_CounterMode_Up;
    TIM_TimeBaseInit(TIM2, &tim);

    // 启动TIM2
    TIM_Cmd(TIM2, ENABLE);

    // 主循环
    while (1) {
        calculate_distance();
        Delay_ms(1000);
    }
}

猜你喜欢

转载自blog.csdn.net/k1419197516/article/details/123981944