智能车辆导航控制技术
- 格式:pdf
- 大小:215.97 KB
- 文档页数:5
文章编号:1671-5497(2004)04-0582-05
收稿日期:2004204221.
基金项目:国家自然科学基金资助项目(50175064).
作者简介:马雷(1973-),男,现在南京航空航天大学作博士后研究.E2mail:malei97yan@163.com
通讯联系人:王荣本(1946-),男,教授,博士生导师.E2mail:wrb@jlu.edu.cn
智能车辆导航控制技术马 雷1,王荣本2(1.南京航空航天大学机电学院,江苏南京 210016;2.吉林大学交通学院,吉林长春 130022)摘 要:首先建立了车辆预瞄运动学方程,并通过系统辨识实验得到了转向系统动态方程,然后获得了完整的基于预瞄运动学模型的转向控制模型。采用滑模变结构控制方法设计了车辆的导航控制器。针对在设计和实验中遇到的一些问题(前轮转角对控制器输出的影响、实验中系统存在静偏差的原因、预瞄点处的侧向偏差与车辆实际侧向偏差之间的关系等)通过仿真进行了系统的分析,并提出在软件中消除净偏差的解决方法。最后现场实验验证了导航控制方法满足车辆导航的要求。关键词:自动控制技术;变结构控制;智能车辆;系统辨识中图分类号:TP242.62 文献标识码:A
IntelligentvehiclesteeringcontrolMALei1,WANGRongben2(1
.CollegeofMechanicalandElectricalEngineering,NanjingUniversityofAeronauticsandAstronautics,Nanjing
210016,China;2.CollegeofTransportation,JilinUniversity,Changchun130022,China
)
Abstract:Apreviewkinematicequationofvehiclewasestablishedatfirst,andadynamicequationforvehiclesteeringsystemwasobtainedthroughsystemidentificationexperiments.Then,amoreintegratedsteeringcontrolmodelwasestablishedbasedonthepreviewkinematicequation.Asteeringcontrollerwasdesignedbymeansoftheslidingvariablestructurecontroltheory.Asimulationwasperformedtoanalyzesystematicallytheproblemsmetinthesystemdesignandexperimentssuchastheeffectofthefront2wheelsteeringangleonthecontrolleroutput,thestaticdeflectionfoundinexperiments,andtherelationbetweenthepreviewlateraldeflectionandvehicleactuallateraldeflection,etc.,andamethodtoeliminatethedeflectioninthecontrolsoftwarewassuggested.Thesteeringcontrolsystemwasverifiedbyfieldtestanditsfavorabletrackcapabilityhasbeendemonstrated.Keywords:automaticcontroltechnology;variablestructurecontrol;intelligentvehicle;systemidentification
随着智能交通运输系统(ITS)的迅速发展,智能车辆[1~5]已成为此领域的研究热点。而车辆的导航控制又是进行智能车辆研究的基础。作者对设计导航控制器和实验验证时遇到的影响车辆导航控制
第34卷 第4期吉林大学学报(工学版) Vol.34 No.4
2004年10月JournalofJilinUniversity(EngineeringandTechnologyEdition) Oct.2004的因素及解决方法进行了定性分析,分析结果对解决导航实验中出现的问题有一定的指导意义。1 车辆转向控制器设计111 模型建立当车辆行驶速度较低,且不考虑轮胎侧偏时,根据车辆运动学可知:
R=L/tanδ(1)式中:R为车辆转弯半径;L为车辆轴距;δ为转向轮转角。在只考虑车辆的平面运动情况下,转向时,车辆只做平面移动和平面旋转运动。车辆的角速度ω
图1 车辆预瞄运动示意图Fig.1 Schematicofvehiclepreviewkinematics
为:
ω=
vx
Ltanδ(2)
式中:vx为车辆后轮轴中心点线速度。图1为车辆预瞄运动示意图。图中,y
L
为车
辆视觉预瞄点处车辆中心线与道路的侧向偏差;eL为车辆视觉预瞄点处车辆中心线与道路切线的夹角。因为车辆既有前向运动,又有侧向运动,根据实际选取的轮距L=2.6m,预瞄距离D
L=14m
时选用运动学模型,模型
中vx暂选为15km/h。基于预瞄的运动学模型为:
y・L=vxeL-ωDL(3)
e・L=vxKL-ω(4)
智能车辆转向系统由步进电机、减速器和原车辆转向系统组成。辨识系统以工业控制机为中心进行测量与控制。工业控制机的D/A为输入信号,前轮的转角为输出信号,通过研究D/A电压值与前轮转角的相互关系可得系统的一阶传递函数如下[6,7]:
G(s)=13.124s+0.475(5)
这样结合系统辨识模型可得转向模型:
X=AX+BU+DKL(6)
式中:A=A11A12A21A22 B=0013.124 X=δyLeL D=
00vx
A11=0vx00 A12=(-vx/L)DL-vx/L A21=(00) A22=(-0.475)112 控制器设计采用滑模变结构控制方法对连续线性系统的滑模控制系统进行设计。第一部分设计系统的切换超平面,并使超平面具有某种优良品质;第二部分设计能在切换超平面附近产生滑动模态的控制输入。设计切换超平面的方法有很多,本文采用二次型最优设计方法。二次型最优设计法的评价函数[7]如下:
J=∫tτs(xT1Q11x1+xT2Q22x2)dt(7)
・385・第4期马 雷,等:智能车辆导航控制技术黎卡提(Riccati)
方程为
:
PA11+AT11P-PA12Q-122A12P+Q11=0 切换超平面S的形式如下:
S=CX=[CaCn]X(8)式中:C为系数矩阵;C
a=AT12P;Cn=Q22=1
,P
为黎卡提方程的解。
通过仿真分析确定Q
11=diag[15 100],Ca=[-3.87 -1.12
]
。达到律采用加速度型达到
律[8],其表达式为:
S・=-G|S|αsgn(S)式中:0控制器的输出为:
u=-(CB)-1{CAX+G|S|αsgn(S)}(9)式中:G=2,α=0.8。
2 导航控制若干技术分析在转向模型式(6)
,车辆前轮转角作为系统的状态变量,
由于车辆其他状态的改变是由前轮转角引
起的,因此分析其对控制器输出的影响。从式(8)可以看出控制器输出分为两部分,其中CAX是使系统状态到达切换超平面的控制项,令:
CAX=[ca1ca2ca3]X(10)
图2 Ca随速度vx的变化曲线Fig.2 CurveofCaversusspeedv
x
图2为在切换超平面系数不变的前提下,系数ca3、ca1、ca2
的值随车辆速度vx的变化曲线。从图中
可知,状态δ所对应的系数ca3随着车辆速度vx的增加而增加的值远大于状态eL和yL所对应系数ca1和ca2
的值。这说明系统对状态δ的约束最大,这样可
以保证在车辆导航的前提下,使状态δ变化的幅度较小,对于提高导航控制的平稳性是有利的。在实验中经常会出现车辆虽然可以平稳导航,但是车辆总是沿着偏离理想路径一段距离行驶,即侧向偏差不是收敛在零附近,而是收敛在正或负的某个值附近。图3和图4为状态eL和δ分别存在系统误差0.05rad时在导航控制器作用下的系统收敛曲线,系统初始状态为[0 0.6 -0.3]。从图3和图4可以看出状态eL和δ分别收敛于-0.05rad,此值与系统误差的和为零,但是系统yL没有收敛在零附近。实际上控制器输出可以看作是以系统状态为自变量的函数,只要这个函数的输出为零,控制器将不调整转向系统。也就是说虽然yL平稳时不为零,但是这样补偿其他状态系统误差,使控制器输出这个函数为零。在实验中如果遇到车辆跑偏的现象,可以通过观测实验数据确定是哪个状态系统误差导致的,在软件中减掉即可。在建立车辆转向控制模型时,所取的侧向偏差在车辆预瞄点处,由于车辆预瞄距离较大,此偏差难以反映车辆在道路中的实际状态,因此应把车辆预瞄点处的侧向偏差转换到车辆在道路中的实际状态。图5为转换示意图,图中y为车辆实际偏差,yi为图像中车辆预瞄点处的侧向偏差,a为图像中心线车辆到道路中心线的距离。根据图5可得下式:
・485・吉林大学学报(工学版)第34卷