stm32f103c8t6超声波测距代码
时间: 2023-11-30 22:04:08 浏览: 37
以下是基于STM32F103C8T6和HC-SR04超声波传感器的测距代码:
```c
#include "stm32f10x.h"
#include "delay.h"
#include "usart.h"
#define TRIG_PIN GPIO_Pin_0
#define TRIG_PORT GPIOA
#define ECHO_PIN GPIO_Pin_1
#define ECHO_PORT GPIOA
void TIM2_Init(void)
{
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
TIM_TimeBaseStructure.TIM_Period = 0xFFFF;
TIM_TimeBaseStructure.TIM_Prescaler = 71;
TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure);
}
float GetDistance(void)
{
GPIO_ResetBits(TRIG_PORT, TRIG_PIN);
delay_us(2);
GPIO_SetBits(TRIG_PORT, TRIG_PIN);
delay_us(10);
GPIO_ResetBits(TRIG_PORT, TRIG_PIN);
while(GPIO_ReadInputDataBit(ECHO_PORT, ECHO_PIN) == RESET);
TIM_SetCounter(TIM2, 0);
while(GPIO_ReadInputDataBit(ECHO_PORT, ECHO_PIN) == SET);
uint16_t high_time = TIM_GetCounter(TIM2);
float distance = high_time * 0.017;
return distance;
}
int main(void)
{
USART_Config();
TIM2_Init();
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
GPIO_InitTypeDef GPIO_InitStructure;
GPIO_InitStructure.GPIO_Pin = TRIG_PIN;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(TRIG_PORT, &GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin = ECHO_PIN;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(ECHO_PORT, &GPIO_InitStructure);
while(1)
{
float distance = GetDistance();
printf("Distance: %.2f cm\r\n", distance);
delay_ms(500);
}
}
```
代码中使用了定时器TIM2来计算超声波的高电平时间,从而计算出距离。其中TRIG_PIN和ECHO_PIN分别连接到HC-SR04的Trig和Echo引脚。