嵌入式Linux下移动机器人超声波测距系统

关键词: 机器人；ARM9；超声波；导航；避障

     在机器人的导航系统中，超声波传感器以其信息处理简单、速度快和价格低等优点，被广泛用作移动机器人的测距传感器，以实现避障、定位和导航等功能。实验室机器人以S3C2410+Linux系统为架构，采用了高精度的SRF05超声波传感器测距，实现对机器人的导航避障。该传感器的回波反馈与测距方式与通用的超声波传感器有所区别，在S3C2410系统中实现也稍有难度，由于传感器精度可达到1cm，因此使用该传感器弥补了通用超声波传感器近距离测距存在盲点的问题，节省了外围红外测距模块等硬件资源。
1 SRF05传感器工作原理
    S3C2410微控制器利用10 μs的高频脉冲触发SRF05传感器，触发下传感器会发出8个40 kHz的超频脉冲，当SRF05传感器的ECHO引脚电平为高时，开启定时器计数器计时；当ECHO变为低电平时，表明机器人遇到障碍物，编程实现定时器停止计时。高脉冲宽度与测距距离有正比关系，SRF05的测距有效范围为1 cm～4 m，无障碍物或遇超大障碍物时，ECHO脚会变为低电平，此过程需要时间为30 ms，设置定时器的周期比超声传感器探测最大距离所需的渡越时间稍长。因此，在测距时定时器周期设置应至少大于30 ms才能有效测距。
2 系统方案设计
2.1 系统组成结构
    轮式移动机器人核心控制系统由触摸屏显示、摄像头图像采集、超声波避障、直流电机闭环控制、人感应传感器、水(火)检测和气体检测模块、串口无线Modem模块部分组成。其中超声波避障模块直接影响机器人行进位移的精度以及在有效范围内的图像采集控制。整个系统基于ARM9架构的S3C2410微控制器与Linux系统平台，使用Linux系统驱动程序控制各个硬件模块^[1]。
2.2 超声波测距系统
    为了实现导航、避障，移动机器人的前、后、左、右各安装1路SRF05超声波传感器，使机器人能够感知4个方位的障碍信息。另外，为了满足系统扩展，可添加安装多路SRF05超声波传感器，进一步增强机器人的导航避障性能。安装超声波传感器之间角度应该大于它的波束角30°，这样传感器同时工作时才不会有干扰。采用分组的方式，左右两套和前后两套分别为一组，组与组之间采用轮循的方式工作。这样既可以得到很高的采集频率，同时也满足了系统的实时性要求。
    采用相关GPIO口作为超声波传感器的INIT触发引脚，并且配置定时器周期，设置定时中断及外部中断。测距流程：开始打开超声波，激发传感器INIT引脚10 ms，打开定时器并开始计时，在定时器周期内收到传感器ECHO低电平触发外部中断，在外部中断处理程序中读取定时器计数值，计算障碍物距离，并且传送给中央处理器。不同组传感器的开启在定时中断中完成，并且开启另一定时器完成计数功能^[2]。系统测距流程图如图1所示。

2.3 采集回波
    S3C2410 GPIO触发中断只能设置一种触发方式，如果设为上升沿触发打开定时器计时，则无法捕获下降沿，也就无法关闭定时器，因此采用软件方式实现。设置2个时间延迟函数usdelay( )和msdelay( )，在给出10 ms高频脉冲后等超声波触发再使能定时器计时，这些在该组传感器对应的定时器中断中完成。并设置外部中断EINT1接收超声波传感器的ECHO回波引脚的变化。其触发方式为下降沿触发，等下降沿来临关闭定时器读出计数值即为脉宽的时间长度时，然后根据距离公式=（ECHO 高电平的时间）×（声纳速度）/2得出距离。空气中V与温度关系：T为摄氏温度^[3]。一般情况下超声波速近似声速，在室内温度影响下取约343.2 m/s。
3 软件实现
3.1 延迟函数实现
    设计软件延迟函数usdelay( )，代码实现如下：
    static int delayLoopCount1=10;
    void usdelay(int time)
    { int i;
      for(;time>0;time－－)
　　    for(i=0;i    函数延迟时间为10μs，打开传感器激发高频脉冲后延迟10μs然后关脉冲，即可利用该函数。
    设计msdelay( )函数用于衡量整个测距周期的时间值。msdelay(1000)延迟大约为1 s，这样系统可以有足够的回波检测时间，同时也不会对其他多路超声波传感器造成信号干扰。msdelay( )代码实现如下：
    static int delayLoopCount2=1310;
    void msdelay(int time)
    { int i;
      for(;time>0;time－－)
　　    for(i=0;i    可以利用PC口相关引脚作为超声波传感器使能端口，程序实现如下：
    rGPCCON=0x555；//端口C为输出口用于启动超声波，可激发多路超声波
    rGPCDAT=0x0；//数据位清0
    rGPCDAT=0xf；//设置为高频脉冲，发出8T 40kHz超频波
    usdelay(1)；//延迟10μs
    rGPCDAT=0x0；//清数据位
3.2 回波检测实现
    利用定时器计数器功能和外部中断可以实现回波检测计算障碍物距离，外部中断接超声波的ECHO并设置为下降沿触发。定时器的初始化如下：
    rTCFG0=0x9595;                                      //预分频值为95
    rTCFG1=0x00000;                                     //分割值1/2
    rTCNTB0=10 000;
    根据T=[TCNTB0×（TCFG0+1）×（1/TCFG1）]/50MHz得出定时器的周期为60ms,在这个时间段内足以计算回波时间。
    外部中断1初始化如下：
    rGPFCON=0xaa;                              //GPF1 设置为 EINT1
    rINTMOD=0x0;                              //为普通中断
    rGPFUP=0xf;                              //禁止 GPF0 上拉电阻
    pISR_EINT1=(unsigned)Eint1Handler;       //设置外部中断
                                             //中断向量
    EnableIrq(BIT_EINT1);                    //使能中断
    rEXTINT0 =0x492;                         // EINT1 下降沿触发
3.3 障碍物距离计算
    void __irq Eint1Handler(void)   // eint1 中断服务子程序
    {  
    　　sonar_time_front =((10000- rTCNTO0) >> 1);//定时器的计数值除以2即为障碍物距离
　　    ClearP