基于双排传感器的循迹策略研究

物联网与传感器   作者:韩光胜,徐喆,宋小舟 时间:2012-06-08来源:电子产品世界

  第二种直道情况 

  第三种直道情况 

  第四种直道情况 

  第五种直道情况 

  2) 直道识别,程序辅助确认

  进入弯道后,随着小车的行进,会发生振荡,致使出弯时不一定满足上述5种情况。为了提高直道的识别成功率,增加第二种直道判别方法。两者同时起作用,满足第一种后经过最多15ms确认是直道。

  程序是循环执行,我们的程序执行频率是2Khz。采用定时中断(15ms)的方式,对前排中间3个传感器(编号为3、4、5)使用3个计数器分别计数,每次执行程序若是其中一个检测到黑线,相对应的计数器加1。经过计算,15ms内所能计数的最大值为31。我们设定计数的最大值,若在15ms内达到所要求的计数值,就认为是直道,切换直道程序并将计数器清零;若15ms内没有达到所要求的计数值,计数器清零,重新计数。例如小车为2m/s的速度,小车行进3cm。我们只要判断2~2.5cm内为直道即可。所以设最大计数值为20~25即认为是直道,跳出弯道程序。

1 2 3 4 5

关键词: 飞思卡尔 传感器 智能车

加入微信
获取电子行业最新资讯
搜索微信公众号:EEPW

或用微信扫描左侧二维码

相关文章

查看电脑版