如何去实现一种基于超声波测距模块的避障智能小车呢

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

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

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