超声波测距程序

嵌入式Linux下移动机器人超声波测距系统———嵌入式Linux下移动机器人超声波测距系统发布:2011-09-07|作者:|来源:liuhaoming|查看:587次|用户关注：摘要：设计了基于S3C2410+Linux平台的移动机器人超声波避障系统。介绍了SRF05新型高精度传感器的工作原理、测距系统多路超声波传感器的软硬件实现及机器人平台的整个软件工作流程。Linux系统超声波驱动模块中采用的轮循工作方式实现了机器人在未知环境下的避障功能，机器人平台运行效果良好。关键词:机器人；ARM9；超声波；导航；避障在机器人的导航系统中，超声波传感器以其信息处理简单、速度快和价格低等优点，被广泛用作移动机摘要：设计了基于S3C2410+Linux平台的移动机器人超声波避障系统。介绍了SRF05新型高精度传感器的工作原理、测距系统多路超声波传感器的软硬件实现及机器人平台的整个软件工作流程。Linux系统超声波驱动模块中采用的轮循工作方式实现了机器人在未知环境下的避障功能，机器人平台运行效果良好。关键词:机器人；ARM9；超声波；导航；避障在机器人的导航系统中，超声波传感器以其信息处理简单、速度快和价格低等优点，被广泛用作移动机器人的测距传感器，以实现避障、定位和导航等功能。实验室机器人以S3C2410+Linux系统为架构，采用了高精度的SRF05超声波传感器测距，实现对机器人的导航避障。该传感器的回波反馈与测距方式与通用的超声波传感器有所区别，在S3C2410系统中实现也稍有难度，由于传感器精度可达到1cm，因此使用该传感器弥补了通用超声波传感器近距离测距存在盲点的问题，节省了外围红外测距模块等硬件资源。1SRF05传感器工作原理S3C2410微控制器利用10μs的高频脉冲触发SRF05传感器，触发下传感器会发出8个40kHz的超频脉冲，当SRF05传感器的ECHO引脚电平为高时，开启定时器计数器计时；当ECHO变为低电平时，表明机器人遇到障碍物，编程实现定时器停止计时。高脉冲宽度与测距距离有正比关系，SRF05的测距有效范围为1cm～4m，无障碍物或遇超大障碍物时，ECHO脚会变为低电平，此过程需要时间为30ms，设置定时器的周期比超声传感器探测最大距离所需的渡越时间稍长。因此，在测距时定时器周期设置应至少大于30ms才能有效测距。2系统方案设计2.1系统组成结构轮式移动机器人核心控制系统由触摸屏显示、摄像头图像采集、超声波避障、直流电机闭环控制、人感应传感器、水(火)检测和气体检测模块、串口无线Modem模块部分组成。其中超声波避障模块直接影响机器人行进位移的精度以及在有效范围内的图像采集控制。整个系统基于ARM9架构的S3C2410微控制器与Linux系统平台，使用Linux系统驱动程序控制各个硬件模块[1]。2.2超声波测距系统为了实现导航、避障，移动机器人的前、后、左、右各安装1路SRF05超声波传感器，使机器人能够感知4个方位的障碍信息。另外，为了满足系统扩展，可添加安装多路SRF05超声波传感器，进一步增强机器人的导航避障性能。安装超声波传感器之间角度应该大于它的波束角30°，这样传感器同时工作时才不会有干扰。采用分组的方式，左右两套和前后两套分别为一组，组与组之间采用轮循的方式工作。这样既可以得到很高的采集频率，同时也满足了系统的实时性要求。采用相关GPIO口作为超声波传感器的INIT触发引脚，并且配置定时器周期，设置定时中断及外部中断。测距流程：开始打开超声波，激发传感器INIT引脚10ms，打开定时器并开始计时，在定时器周期内收到传感器ECHO低电平触发外部中断，在外部中断处理程序中读取定时器计数值，计算障碍物距离，并且传送给中央处理器。不同组传感器的开启在定时中断中完成，并且开启另一定时器完成计数功能[2]。系统测距流程图如图1所示。2.3采集回波S3C2410GPIO触发中断只能设置一种触发方式，如果设为上升沿触发打开定时器计时，则无法捕获下降沿，也就无法关闭定时器，因此采用软件方式实现。设置2个时间延迟函数usdelay()和msdelay()，在给出10ms高频脉冲后等超声波触发再使能定时器计时，这些在该组传感器对应的定时器中断中完成。并设置外部中断EINT1接收超声波传感器的ECHO回波引脚的变化。其触发方式为下降沿触发，等下降沿来临关闭定时器读出计数值即为脉宽的时间长度时，然后根据距离公式=（ECHO高电平的时间）×（声纳速度）/2得出距离。空气中V与温度关系：T为摄氏温度[3]。一般情况下超声波速近似声速，在室内温度影响下取约343.2m/s。3软件实现3.1延迟函数实现设计软件延迟函数usdelay()，代码实现如下：staticintdelayLoopCount1=10;voidusdelay(inttime){inti;for(;time0;time－－)for(i=0;i函数延迟时间为10μs，打开传感器激发高频脉冲后延迟10μs然后关脉冲，即可利用该函数。设计msdelay()函数用于衡量整个测距周期的时间值。msdelay(1000)延迟大约为1s，这样系统可以有足够的回波检测时间，同时也不会对其他多路超声波传感器造成信号干扰。msdelay()代码实现如下：staticintdelayLoopCount2=1310;voidmsdelay(inttime){inti;for(;time0;time－－)for(i=0;i可以利用PC口相关引脚作为超声波传感器使能端口，程序实现如下：rGPCCON=0x555；//端口C为输出口用于启动超声波，可激发多路超声波rGPCDAT=0x0；//数据位清0rGPCDAT=0xf；//设置为高频脉冲，发出8T40kHz超频波usdelay(1)；//延迟10μsrGPCDAT=0x0；//清数据位3.2回波检测实现利用定时器计数器功能和外部中断可以实现回波检测计算障碍物距离，外部中断接超声波的ECHO并设置为下降沿触发。定时器的初始化如下：rTCFG0=0x9595;//预分频值为95rTCFG1=0x00000;//分割值1/2rTCNTB0=10000;根据T=[TCNTB0×（TCFG0+1）×（1/TCFG1）]/50MHz得出定时器的周期为60ms,在这个时间段内足以计算回波时间。外部中断1初始化如下：rGPFCON=0xaa;//GPF1设置为EINT1rINTMOD=0x0;//为普通中断rGPFUP=0xf;//禁止GPF0上拉电阻pISR_EINT1=(unsigned)Eint1Handler;//设置外部中断//中断向量EnableIrq(BIT_EINT1);//使能中断rEXTINT0=0x492;//EINT1下降沿触发3.3障碍物距离计算void__irqEint1Handler(void)//eint1中断服务子程序{sonar_time_front=((10000-rTCNTO0)1);//定时器的计数值除以2即为障碍物距离ClearPending(BIT_EINT1);//清除中断标志位i++;Uart_Printf('nEINT1occuredtimes=%dn',i);//串口打印调试显示中断发生次数Uart_Printf('nsonar_time_front=%d',sonar_time_front);//串口打印显示计算器计数值t1=sonar_time_front*0.204;//计算距离值front_range=t1;//赋值全局变量}3.4轮循方式测距由于超声波之间有干扰，采用轮询[4]的方式依次打开超声波，定时中断中启动下一路超声波传感器工作，下一路对应的定时中断再启动其他路，每次只测1个，这样可以有效地避免干扰，为了提高实时性可以控制定时器周期，如设置为35ms，这样4路超声波轮循1次大约为140ms，足以满足实时要求。4机器人行进过程利用多路超声波传感器的反馈障碍物信息控制机器人直流电机驱动系统的软件流程图如图2所示。嵌入式Linux系统中SRF05模块为只读的字符设备。在应用层下打开该设备后，驱动程序完成测距，测得的数据传到应用层，应用层根据算法判断障碍物的位置给直流电机，控制系统实现避障导航[5]。机器人的每次行为都是根据超声波测距模块和当前机器人运行的即时速度给出运行时间，在遇到障碍物时（0[6]。采用新型SRF05超声波传感器，在S3C2410+Linux平台的移动机器人上实现了超声波的测距，并利用超声波传感器控制驱动系统和图像采集系统。各模块驱动程序已成功加载到嵌入式Linux操作系统中，在此平台下机器人运行效果良好。参考文献[1]RUBINIA.Linux设备驱动程序.LISOLEG译.北京：中国电力出版社,2000:66-76.[2]BILLURB.Fastprocessingtechniquesforaccurateultrasonicrangemeasurements[J].MeasurementScienceandTechnology,2000,11(1):45-50.[3]王峰,葛立峰.一种高精度超声测距系统的设计[J].计算机技术与发展，2008，18(1):229-236.[4]陈春林,陈宗海,卓睿．基于多超声波传感器的自主移动机器人探测系统[J].测控技术，2004，23(6):11-13.[5]TIKANMKIA,MKELT,PIETIKINENA,etal.Multi-robotsystemforexplorationinanoutdoorenvironment[J].RoboticsandApplicationsandTelematics,2007,9(1):563-567.[6]DaiG,ChenT.Designonmeasurementandcontrolsystemofcleaningrobotbasedonsensorarraydetection[J].ControlandAutomation,2007.ICCA2007.IEEEInternationalConferenceonVolume,Issue,2007-05-30～2007-06-01:1319-1322.