当前位置:首页 > 工业控制 > 工业控制
[导读]介绍了基于MC9S12XS128单片机控制的智能车系统,该系统以CCD摄像头传感器作为路径识别装置,通过图像识别提取道路黑线信息,计算出反应道路形状的舵机控制量,对舵机进行控制。对智能车寻线舵机控制系统的软件设计思路和控制算法思想等进行了详细的论述。测试结果表明智能车能准确稳定地跟踪引导黑线行驶,该算法能够很好地对智能车进行控制。

自动寻迹智能车涉及到当前高技术领域内的许多先进技术,其中最主要的是传感技术、路径规划和运动控制。本课题是以飞思卡尔智能车竞赛为背景,以单片机作为核心控制单元,以摄像头作为路径识别传感器,以直流电机作为小车的驱动装置,以舵机控制小车转向。车模竞赛的赛道是一个具有特定几何尺寸约束、摩擦系数及光学特性的KT板,其中心贴有对可见光及不可见光均有较强吸收特性的黑色条带作为引导线,宽度为2.5 cm。在行驶过程中,系统通过摄像头获取前方赛道的图像数据,同时通过测速传感器实时获取智能车的速度,采用路径搜索算法进行寻线判断和速度分析,然后作控制决策,控制转向舵机和直流驱动电机工作。智能车通过实时对自身运动速度及方向等进行调整来“沿”赛道快速行驶。本文主要介绍摄像头通过提取赛道黑线信息交予单片机处理,通过单片机输出控制信号控制舵机转向来控制车模的转向,从而很好的自动循迹。

1 总体软硬件结构及思路
   
此智能车辆定位系统用摄像头拍摄车辆前方的赛道,通过MC9S12XS128采样视频信号,获得图像数据。然后用合适的算法,如跟踪边缘检测算法,分析图像数据,提取目标指引线。然后,系统根据目标指引线的位置信息,对舵机和电机施以合适的控制。本智能车运动系统的结构图如图1所示。


    因为系统是一个有机的整体,所以需配合好系统的摄像头、控制单片机、电机(包括直流伺服电动机、光电编码器)、舵机和辅助电路(电源板、电机驱动板)等各个部分。舵机是实时控制车模的转向,是比赛快速性和稳定性的关键,舵机控制有很多的控制算法,如:PID经典控制算法、模糊算法、人工智能算法等。

2 系统程序总体控制流程
   
系统的基本软件流程是:首先,对各功能模块和控制参数进行初始化;然后,通过图像采集模块获取前方赛道的图像数据,同时通过速度传感器模块获取赛车的速度。采用PID对舵机进行反馈控制。另外根据检测到的速度,结合速度控制策略,对赛车速度不断进行适当调整,使赛车在符合比赛规则的前提下,沿赛道快速行驶。系统的基本软件结构流程图,如图2所示。


    系统的软件要求控制的准确性、稳定性。采样提取黑线是控制输入量的基础,要求采样的精确稳定。输入量给舵机以后又要求舵机输出的快速相应性、稳定性和准确性。经过多次实验及近一个学期的调车经验,选用了并改进了经典的PID控制器对车模的舵机进行控制调节。

3 图像识别
   
CCD摄像头采集车模前方一定距离内的黑线,从中提取相关量,用来控制舵机的转向,实现智能车的自动循迹。由于单片机数据处理能力和速度有限,不能在短短的20 ms时间内处理整场图像。本系统设置摄像头前瞻为1.2 m。在不影响道路检测精度需要的前提下,本系统采用隔行采集来压缩图像数据,即相隔不同的有效行采集一行数据(近处相隔的少,远处相隔的多),一共可采集44行数据。此外为了进一步提高A/D转换的速度,本系统还适当地将XS12的CPU超频运行并且设置A/D转换器的精度为8位,这样每行能采样到67个点,形成了一个面阵,而黑线在其中占据了某些点位。由于我们一行采集67个点,故中间值为33。图像是智能车的底层,图像的采集正确与否在以后的控制中尤为重要,故一定要确保采集回来的黑线的真实有效性,并且要增加滤波算法,比如在有效前瞻很小的时候,本来只要判断出黑线的转向即可,给舵机以极限转角可以让车急转弯。但是有效行很少的时候,如果不用特殊的滤波方法,只要有一行的黑线提错,就可能让小车转错,至于转出界。

4 分段PID控制
4.1 图像信息提取量
   
从采集回来的图像中提取控制量来控制舵机的转向,实现智能车的自动循迹。本系统采用黑线偏移量even_diff和黑线某段斜率D_diff-erent对舵机进行控制,可称为PD控制器。由于车模是个随动系统,在摄像头1.2 m前瞻内覆盖的黑线不一定有设置的44行,特别是前方的弯特别急的时候,在摄像头前瞻视角范围内覆盖的黑线会特别少,比如13行或13行以下。根据这个特点,可设置一个有效前瞻量valid_line作为对前方的弯的平缓程度的反应。
    把每一行的黑线位置值与中间值作差,得到该行的偏移量,中间值33位赛道的中心位置点,偏移量表示在车模的视角下黑线处于赛道中的位置值。把每一行的偏移量相加之和除以摄像头前瞻范围内的提取出的黑线行数,得到黑线相对于车模中心的整体偏移量even_diff,用有效行内的远处某些行与近处某些行(如前半场与后半场)偏移量之差得到有效行内的黑线斜率D_differen。
    这样,从一场的黑线位置数据中,系统提取了有效行valid_line、even_diff、D_different 3个量来对舵机进行控制。在实际情况中,D_different可以很灵活,因为前方黑线的斜率可以取不同段得到,可以根据实际要求得到不同段的斜率值,如速度快时可以适当的取距车较远处的黑线斜率,以实现超前控制。
    在智能车调试参数的时候,对这3个量的理解很是重要,具体来说,valid_line表征车模的有效前瞻,即看得有多远,对于智能车在道路上行驶,看得远说明黑线都在前方,看不远说明智能车前方的黑线已经偏左或者偏右,而这个量的大小正好可以表征弯的平缓与急切。另外,看得远则摄像头采集的黑线多,系统信息量大,那么怎么处理这些大量的信息为我们所用就变得很关键,如看得1.2 m都能看见,说明小车必然在长直道上,不然也是小S弯,稍作处理就可以过滤掉小S弯了,让小车像都是在直道上跑;看得很近说明弯已经很急,这时候,只要能够判断出弯往那边拐就可以给舵机一个极值急拐。even_diff表征在某一个特定视野下,小车与黑线偏离的程度,这个量可以让智能车在某个特定视野下决定给舵机多大的转角。D_different则在有效前瞻远的时候尤为关键,因为它可以预判前方的弯,从而超前的转弯。
4.2 PD控制器形式
   
系统把这3个量处理成PD控制器的形式:
   
    其中a为根据赛道有效前瞻确定的不同有效行。Centre为舵机走直线的控制中间值。Steer为PD控制器给舵机的输入量。由于车模舵机转向控制是一个非线性系统,而设置了入口条件“有效行判断”,正好可以把这个非线性系统分割成不同段,在每一段可近似认为转向控制系统是线性的。即在某一小段范围内,得到的黑线位置和对应的舵机PID参照角度处理成一次线性关系。最终实现简单分段PID控制。

5 分段PID控制参数规律
   
在实际的调车过程中,我们总结发现,PD控制器的参数Kp、Kd与有效前瞻valid_line、车模的速度相关。简单点说,即小车速度越快,车模遇弯提前拐弯的应越早。总结下来,有如下关系:
   
    其中A为Kp的基础值,valid_line为车模运行到某个状态的有效前瞻(用提取的黑线数量来估定),speed为小车一场时间内的脉冲值,表征车模时刻运行的速度。低速时,可近似认为speed/C为零,通过试验法可以确定A值大小。在确定Kp基础值之后,即可加速,在小车速度稍高的时候调试得出合适的B值、C值,最终使小车平稳准确的切线,循迹而行。此关系式可知,有效前瞻的变化是对Kp值影响最大也是最直接的一个量,我们平时调车经验而知,B参数应比C敏感很多才行。有效行减少一行,对舵机转向角的影响要远大于小车速度speed对Kp的对影响。而speed对舵机急转快速性在车模高速的时候很是明显。
    为增加系统的鲁棒性,并且更好的解决系统的非线性问题,我们将小车的前瞻分段,我们1.2 m的前瞻里面,总共有44行黑线,直道上全部提取回来,可以分为有效行37行一下、有效行30行以上、有效行24行以上、有效行18行以上、有效行13行以上与有效行13行以下7段。
    处理成控制程序的形式为:

    虽然分为7段,各段单独控制,参数单独调节,但是,Kp值与有效行(有效前瞻)成负相关的关系仍然成立,故Kp、Kp1、Kp2、Kp3、Kp4、Kp5依然大体上遵循与有效行负相关的关系,即Kp随有效行的减小线性增加。
    在每一段里面调节PD控制器的参数,使小车能够行使不同类别不同半径的弯道。这样就形成分段PD控制,小车的非线性问题可以很好的解决,系统的鲁棒性也能够增强。同时,为保护舵机不至于向左向右打得太狠,可以限定舵机的左右极限值:
  
    通过调试参数A、B、C,调节不同的Kp值,实践证明,小车能够平稳、快速的自动巡线前行。

6 结束语
   
该算法把舵机的转向的Kp系数与车速相关起来,能够很好地配合车速与舵机转向,提出以具体的智能车参数分段PD参数的规律,对智能车实际制作很有帮助,在智能车比赛中具有很广的推广价值。
    实践证明,参数调节合适的时候智能车能够很好的适应赛道,跑出希望的最佳路径。为了参加第五届“飞思卡尔”杯全国大学生智能汽车竞赛,此控制算法在校级代表队资格选拔赛中表现完美,最终跑出2.5 m/s的好成绩,成功入选华北赛区参加比赛。实践证明了智能车舵机分段PID控制转向具有可行性和实用性。

本站声明: 本文章由作者或相关机构授权发布,目的在于传递更多信息,并不代表本站赞同其观点,本站亦不保证或承诺内容真实性等。需要转载请联系该专栏作者,如若文章内容侵犯您的权益,请及时联系本站删除。
换一批
延伸阅读

常州2023年9月25日 /美通社/ -- 9月23日,由江苏省商务厅指导,世界中餐业联合会、常州市人民政府主办的"第三届中华节气菜大会暨首届江南美食节"在江苏常州开幕。文化和旅游部国际交流与合作局一...

关键字: BSP 可持续发展 大赛 质量控制

北京2023年9月25日 /美通社/ -- 9月21日,由中国质量报刊社·中国质量新闻网主办的第六届食品高质量发展交流会在北京举行,会议主题为"高质量,新生活",旨在推动食品行...

关键字: 自动化 BSP ISO9001 NAS

北京2023年9月23日 /美通社/ -- 近日,主线科技正式获准在北京市智能网联汽车政策先行区道路开启常态化测试与示范,将与物流客户在真实开放的城区道路场景中,率先开启基于L4级别自动驾驶能力的智能卡车运输示范。 随...

关键字: 智能卡 测试 高速公路 BSP

曼谷2023年9月18日 /美通社/ -- 作为东南亚的旅游胜地,泰国一直在全球范围内吸引着无数游客的目光。泰国旅游和体育部近日公布的报告显示,今年前7个月,泰国旅游业总收入约为1.08万亿泰铢(约合人民币2233亿元)...

关键字: BSP GEN 国美 AN

哥伦比卡尔达斯2023年9月22日 /美通社/ -- 近日,天合跟踪与中国电建签订拉美地区哥伦比亚泰普伊光伏电站跟踪支架供货协议,将为其提供108MW智能跟踪系统,其中包含开拓者1P智能跟踪支架、智能算法、以及智慧云平台...

关键字: 光伏电站 跟踪系统 控制器 BSP

2型炎症领域新突破 上海2023年9月22日 /美通社/ -- 赛诺菲今天宣布,达必妥®(度普利尤单抗注射液)获得中国国家药品监督管理局(NMPA)批准,用于治疗适合系统治疗的中度至重度结节性痒疹的成...

关键字: PRIME BSP REPORT SAR

欧莱雅中国旗下上海美次方投资有限公司达成首次开放式创新投资 法国克里希2023年9月22日 /美通社/ -- 欧莱雅集团宣布对中国创新型生物科技公司杉海创新进行少数股权投资,以建立长期合作伙伴关系,共同开发新...

关键字: AN BSP DEVELOPMENT FOR

赋能企业实现业务数据的可识别、可见、可协作和安全数据的可操作 北京2023年9月22日 /美通社/ -- 亚马逊云科技持续加速分析与安全服务创新,守护安全基座,助力企业进一步释放数据要素价值,实现创新增长。在数字经济时...

关键字: 亚马逊 BSP 生成式AI SECURITY

重庆2023年9月22日 /美通社/ -- 全球领先的高端半导体封装载板和印制电路板制造商奥特斯连续第八年受邀,出席重庆市市长国际经济顾问团于9月22日举行的第十七届年会。 奥特斯连续第八年受邀,出席重庆市市...

关键字: BSP 印制电路板 微型 微电子

科威特科威特城2023年9月21日 /美通社/ -- 秉承去年突破性科技、金融和数字银行创新峰会的势头,/MoneyTech将于11月12日重返科威特。  请在 aljaridasummits.com ...

关键字: MONEY TE BSP MIT
关闭
关闭