智能小车的超声波避障实现过程

在硬件综合训练这门课程中，我们以小组的形式完成了基于stm32f103vc的智能小车的制作，实现的主要功能有：遥控、避障、语音控制、人脸识别以及舵机控制摄像头旋转。其中我主要负责的是stm32板的开发，以下是超声波避障的实现过程。

1. 超声波模块的介绍
   我们所用的是HC-SR04超声波测距模块，它可以测量 3cm – 4m 的距离，精确度可以达到 3mm。
   
2. 超声波模块的工作原理
   （1）采用IO口TRIG触发测距，给至少10us的高电平信号;
   （2）模块自动发送8个40khz的方波，自动检测是否有信号返回；
   （3）有信号返回，通过IO口ECHO输出一个高电平，高电平持续的时间就是超声波从发射到返回的时间。测试距离=（高电平时间*声速/2;
   （4）本模块使用方法简单，一个控制口发一个10US以上的高电平，就可以在接收口等待高电平输出。一有输出就可以开定时器计时，当此口变为低电平时就可以读定时器的值，此时就为此次测距的时间，方可算出距离。如此不断的周期测，即可以达到你移动测量的值。
3. 超声波模块电路图
   
4. 超声波模块时序图
   
5. 超声波模块实现代码
   时钟与GPIO初始化：

void iniTim()
{
TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructer;
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
TIM_TimeBaseInitStructer.TIM_Period=9999;// 定时周期 .1s 100ms overflow
TIM_TimeBaseInitStructer.TIM_Prescaler=71;  // 72 000 000 1mhz 1us
TIM_TimeBaseInitStructer.TIM_ClockDivision=0;
TIM_TimeBaseInitStructer.TIM_CounterMode=TIM_CounterMode_Up;
TIM_TimeBaseInitStructer.TIM_RepetitionCounter = 0;
TIM_TimeBaseInit(TIM2,&TIM_TimeBaseInitStructer);

TIM_Cmd(TIM2,ENABLE);
TIM_ITConfig(TIM2,TIM_IT_Update,ENABLE);

NVIC_InitTypeDef NVIC_InitStructure;
NVIC_InitStructure.NVIC_IRQChannel=TIM2_IRQn;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=0;
NVIC_InitStructure.NVIC_IRQChannelSubPriority=0;
NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
NVIC_Init(&NVIC_InitStructure);

TIM_Cmd(TIM2,DISABLE);// 关闭定时器使能

GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);

/*TRIG 信号 */
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_8;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
GPIO_Init(GPIOB, &GPIO_InitStructure);
/*ECOH 信号 */
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_6;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IN_FLOATING;
GPIO_Init(GPIOB, &GPIO_InitStructure);

GPIO_InitStructure.GPIO_Pin=GPIO_Pin_7;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
GPIO_Init(GPIOB, &GPIO_InitStructure);

GPIO_InitStructure.GPIO_Pin=GPIO_Pin_9;
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
GPIO_Init(GPIOB, &GPIO_InitStructure);

GPIO_ResetBits(GPIOB,GPIO_Pin_9);//关闭距离过远led
}

测距函数：

double get_length(void)
{
GPIO_SetBits(GPIOB,GPIO_Pin_8);
Delay_us(11);
GPIO_ResetBits(GPIOB,GPIO_Pin_8);
while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_6) == RESET);
TIM2->CNT = 0;//清零计时器
TIM_Cmd(TIM2,ENABLE);// 回响信号到来，开启定时器计数
while(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_6)==SET);
TIM_Cmd(TIM2,DISABLE);// 关闭定时器

if(!toofar) //没有完成一次计数周期,即距离不是很远
{
t=TIM_GetCounter(TIM2);// 获取 TIM2 寄存器中的计数值
time = (double)t/(double)1000000; //往返时间,单位s
length =  340*time/2; //单程长度,单位m
TIM2->CNT=0; // 将 TIM2 计数寄存器的计数值清零
}
else
{
toofar = 0;
length =99; //足够远,不用考虑
TIM2->CNT=0; // 将 TIM2 计数寄存器的计数值清零
}
return length;
}

设置中断：

void TIM2_IRQHandler(void) // 中断，当距离足够远时,设置toofar = 1,不必再计算
{
if(TIM_GetITStatus(TIM2,TIM_IT_Update)!=RESET)
{
TIM_ClearITPendingBit(TIM2,TIM_IT_Update);// 清除中断标志
toofar = 1;
GPIO_ResetBits(GPIOB,GPIO_Pin_9);
}
}

主函数：

int main(void)
{
SysTick_Init();
iniTim();
while(1)
{
double len = 0;
len = get_length();
if ( len < 0.5 ) //如果距离够近
{
GPIO_SetBits(GPIOB,GPIO_Pin_7);//点亮距离过近led
GPIO_ResetBits(GPIOB,GPIO_Pin_9);//复位距离过远led
}
else
{
if(toofar)//距离长到tim溢出，> 17m
{
GPIO_SetBits(GPIOB,GPIO_Pin_9);//点亮距离过远led
GPIO_ResetBits(GPIOB,GPIO_Pin_7);//复位距离过近led
}
else
{
GPIO_ResetBits(GPIOB,GPIO_Pin_7);//复位距离过近led
GPIO_ResetBits(GPIOB,GPIO_Pin_7);//复位距离过近led
}
}
}
}

注：我添加了两个led灯来判断超声波测距功能的实现，其中
PB7引脚上连接的是距离过近led，如果近距离内出现障碍，它会亮起；
PB9引脚上连接的是距离过远led，如果在很远的距离范围里都没有障碍，它会亮起。

• 点赞 7
• 收藏
• 分享
• 文章举报