CN111688704A - 一种基于驾驶状态预测的人机力矩协同转向控制方法 - Google Patents
一种基于驾驶状态预测的人机力矩协同转向控制方法 Download PDFInfo
- Publication number
- CN111688704A CN111688704A CN202010588218.9A CN202010588218A CN111688704A CN 111688704 A CN111688704 A CN 111688704A CN 202010588218 A CN202010588218 A CN 202010588218A CN 111688704 A CN111688704 A CN 111688704A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- driver
- road
- follows
- unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 90
- 230000006870 function Effects 0.000 claims description 47
- 239000011159 matrix material Substances 0.000 claims description 41
- 230000009471 action Effects 0.000 claims description 21
- 238000012546 transfer Methods 0.000 claims description 18
- 230000000694 effects Effects 0.000 claims description 12
- 238000005457 optimization Methods 0.000 claims description 12
- 230000008447 perception Effects 0.000 claims description 12
- 230000001629 suppression Effects 0.000 claims description 9
- 230000000007 visual effect Effects 0.000 claims description 9
- 238000009795 derivation Methods 0.000 claims description 6
- 230000003247 decreasing effect Effects 0.000 claims description 5
- 230000002232 neuromuscular Effects 0.000 claims description 4
- 230000006978 adaptation Effects 0.000 claims description 3
- 238000013459 approach Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 238000012938 design process Methods 0.000 claims description 3
- 238000004134 energy conservation Methods 0.000 claims description 3
- 230000010365 information processing Effects 0.000 claims description 3
- 230000000116 mitigating effect Effects 0.000 claims description 3
- 210000003205 muscle Anatomy 0.000 claims description 3
- 210000000653 nervous system Anatomy 0.000 claims description 3
- 230000035484 reaction time Effects 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 210000000697 sensory organ Anatomy 0.000 claims description 3
- 230000009467 reduction Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 7
- 206010063385 Intellectualisation Diseases 0.000 description 2
- 210000004556 brain Anatomy 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 210000005036 nerve Anatomy 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000001151 other effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0029—Mathematical model of the driver
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0031—Mathematical model of the vehicle
- B60W2050/0034—Multiple-track, 2D vehicle model, e.g. four-wheel model
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种基于驾驶状态预测的人机力矩协同控制方法,通过建立人‑车‑路模型实现对驾驶状态的预测,基于人‑车‑路模型和模型预测控制方法设计基于驾驶状态预测的人机力矩协同转向控制器,为了提高人机一致性,在建立人‑车‑路模型时引入辅助强度系数,并通过模糊逻辑方法实时确定辅助强度系数;为了进一步减轻驾驶负担,对驾驶员引导系数进行拟合并根据驾驶员引导系数对驾驶员进行引导,减小驾驶员输出力矩;本方法可以使车辆更好地跟随期望路径,提高路径跟踪精度;改变辅助强度系数,减少了人机之间的冲突;过对驾驶员引导,减轻了驾驶员驾驶负担。
Description
技术领域
本发明属于智能驾驶控制技术领域,涉及一种基于驾驶状态预测的人机力矩协同转向控制方法,是考虑车辆安全性与驾驶体验的人机协同转向控制方法。
背景技术
近些年来,传统车辆正在面临着向新四化方面转型,主要包括电动化、共享化、网联化、和智能化,意在让车辆行驶更加节能、环保和安全。对于车辆而言安全无疑是最重要,在安全的基础上再进一步提升其他方面的效果。而智能化无疑是针对提高车辆的行驶安全性而提出的,针对智能车辆的研究,最高的目标就是实现无人驾驶,而在实现无人驾驶之前,人机协同控制是一个长期存在的问题。希望通过人机协同配合在保证车辆安全性的基础上减轻驾驶员驾驶负担提升驾驶体验,以人机协同作为过渡阶段,为最终实现无人驾驶打下基础。
发明内容
一种基于驾驶状态预测的人机力矩协同转向控制方法,通过建立人-车-路模型实现对驾驶状态的预测,基于人-车-路模型和模型预测控制方法设计基于驾驶状态预测的人机力矩协同转向控制器,为了提高人机一致性,在建立人-车-路模型时引入辅助强度系数,并通过模糊逻辑方法实时确定辅助强度系数;为了进一步减轻驾驶负担,对驾驶员引导系数进行拟合并根据驾驶员引导系数对驾驶员进行引导,减小驾驶员输出力矩,其特征在于,本方法的步骤如下:
步骤一、建立人-车-路的简化模型
建立地面坐标系,原点O固结于当前时刻车辆质心o所处位置,X轴指向当前时刻车身正前方,X轴沿逆时针方向旋转90度的方向为Y轴正方向;
建立车身坐标系,原点与车辆质心o重合,x轴指向车身正前方,x轴沿逆时针方向旋转90度为y轴正方向,z轴指向车身正上方并垂直于x轴和y轴;
(1)驾驶员模型建立
两点预瞄驾驶员模型结合远近道路的两个区域的道路信息,远点F作为预测点,反应未来要达到的大致方向,近点N作为补偿点,使驾驶员逐渐调整到期望轨迹上,主要包括以下环节:
远预瞄角θfar为车辆质心o到远点F的方向与车身正前方的夹角,单位:rad;远预瞄距离lfar为车辆质心o到远点F的距离,单位:m;根据几何关系和运动学原理,得到远预瞄角θfar的表达式如下:
其中,Rv为车辆质心o轨迹的曲率半径,单位:m;r为车辆横摆角速度,单位:rad/s;vx为车辆坐标系下车辆纵向速度,单位:m/s;
近预瞄角θnear为车辆质心o到近点N的方向与车身正前方的夹角,单位:rad;近预瞄距离lnear为车辆质心o到近点N到车辆前进方向垂点的距离lnear,单位:m;横向偏移量yL为近点N到车辆前进方向的垂直距离,单位:m;由于近预瞄角θnear通常较小,得到近预瞄角θnear表达式如下:
当车辆在直线上行驶时远预瞄角θfar为零,当车辆在弯道上行驶时,根据道路弯曲程度来确定远预瞄距离lfar,也即确定远预瞄角θfar;
为了产生正比于远预瞄角θfar的驾驶员模型输出力矩Td,引入视觉超前控制环节,视觉超前控制环节的输入为θfar、输出为Tant,视觉超前控制环节的传递函数Ga(s)如下:
Ga(s)=Kα (3)
其中,Ka为远预瞄角θfar的比例增益,反应驾驶员对远预瞄角θfar的感知程度,本方法中选取Ka=22;
为了基于近预瞄角θnear生成与近预瞄距离lnear相关的纠正转向角,以确保驾驶员模型的路径跟踪精度,引入车道保持补偿控制环节,车道保持补偿控制环节的输入为θnear、输出为Tcom,车道保持补偿控制环节的传递函数Gc(s)如下:
其中,Kc为近预瞄角θnear的比例增益,反应驾驶员对近预瞄角θnear的感知程度,本方法中选取Kc=14;TL为驾驶员模型的超前时间常数,单位:s,本方法中选取TL=2.4;TI为驾驶员模型的滞后时间常数,单位:s,本方法中选取TI=0.2;
为了反映驾驶员感觉器官和神经系统处理信息的延时,引入延时环节进行等效,延时环节的输入为Tant+Tcom、输出为Tr,不同驾驶员的反应时间是不同的,取一次近似得到延时环节的传递函数GL(s)如下:
其中,τp为延时环节时间常数,单位:s,本方法中选取τp=0.04;
为了模拟驾驶员作用于转向系统而产生的肌肉运动的知觉部分,引入感知环节和动作环节两个子系统,感知环节的输入为δf、输出为Tf,动作环节的输入为Tf、输出为Tm,感知环节的传递函数Gk1(s)和动作环节的传递函数Gk2(s)如下:
其中,KD为感知环节的比例增益,本方法中选取KD=1;KG为动作环节的比例增益,本方法中选取KG=-0.63;T1为感知环节时间常数,单位:s,本方法中选取T1=2.5;Tk1为动作环节的超前时间常数,单位:s,本方法中选取Tk1=1.99; Tk2为动作环节的滞后时间常数,单位:s,本方法中选取Tk2=0.013;
驾驶员手臂输出的转矩作用于转向盘从而控制车辆实现车道保持,驾驶员手臂动力学环节的输入为Tr-Tm-Tf、输出为驾驶员模型输出力矩Td,驾驶员手臂动力学环节的传递函数Gnm(s)近似后如下:
其中,TN为驾驶员手臂动力学模型时间常数,单位:s,本方法中选取TN=0.11;
同时,为了实现驾驶员模型与自动驾驶控制器人机共驾合作控制,驾驶员模型将被集成到自动驾驶控制器设计过程中,从而获得驾驶员模型在驾驶行为上的预测,驾驶员模型可以等效为一个三输入[θnear θfar δf]、单输出Td的模型,由上式可得驾驶员模型的状态空间方程如下:
式中:
xd=[Td xd2 xd3 xd4 xd5]T
ud=[θfar θnear δf]T
Cd=[1 0 0 0 0]
其中,xd为驾驶员状态矩阵;Td为驾驶员模型输出力矩,单位:N·m; xd2、xd3、xd4和xd5为视觉超前控制环节、车道保持补偿控制环节、延时环节、感知环节、动作环节和驾驶员手臂动力学环节输入输出的线性组合,没有实际物理意义;Αd为驾驶员系统矩阵;Bd为驾驶员输入矩阵;Cd为驾驶员输出矩阵;ud为驾驶员控制量矩阵;yd为驾驶员输出矩阵;δf为车辆前轮转角,单位:rad;
(2)车量动力学模型建立
本方法中车辆动力学模型采用车辆二自由度模型;根据力矩和转矩平衡方程,得到车辆侧向速度vy和车辆横摆角速度r表达式如下:
其中,m为车辆的质量,单位:kg;vy为车辆坐标系下车辆侧向速度,单位:m/s;vx为车辆坐标系下车辆纵向速度,单位:m/s;r为车辆横摆角速度,单位:rad/s;Fyf为车辆前轮侧向力,单位:N;Fyr为车辆后轮侧向力,单位: N;Iz为车辆绕z轴的转动惯量,单位:kg·m2;lf为车辆质心o到车辆前轴的距离,单位:m;lr为车辆质心o到车辆后轴的距离,单位:m;
本方法中进行小角度近似,认为车辆轮胎通常工作在线性区域,得到车辆前轮侧向力Fyf和车辆后轮侧向力Fyr如下:
其中,Cf为线性化的车辆前轮轮胎的侧偏刚度,单位:N/rad;Cr为线性化的车辆后轮轮胎的侧偏刚度,单位:N/rad;αf为车辆前轮胎侧偏角,单位: rad;αr为车辆后轮胎侧偏角,单位:rad;
车辆前轮胎侧偏角αf和车辆后轮胎侧偏角αr近似后如下:
整理可得线性二自由度车辆的状态空间方程如式(12):
(3)车辆运动学模型
vY为地面坐标系下车辆侧向速度,单位:m/s;vX为地面坐标系下车辆纵向速度,单位:m/s;地面坐标系下车辆侧向速度vY、地面坐标系下车辆纵向速度vX和车辆坐标系下车辆侧向速度vy、车辆坐标系下车辆纵向速度vx关系如下:
其中,ψ为车辆横摆角,单位:rad;
假设车辆横摆角ψ较小,如果车辆前轮胎侧偏角αf和车辆后轮胎侧偏角αr保持在正常工作范围内,可进一步假设vy远小于vx,得:
定义车辆横摆角偏差ψL如下:
ψL=ψ-ψd (15)
其中,ψd为期望的车辆横摆角,单位:rad;
为了跟踪期望路径,选取车辆横摆角偏差ψL与横向偏移量yL来进行建模,这两个量可以很好的反应车辆跟踪期望路径的状态;
其中,ρ为道路曲率,单位:1/m;
横向偏移量yL通过几何关系可以近似表示如下:
yL=yvc+lnearψL (17)
其中,yvc为车辆质心o当前位置与期望路径之间的偏差,单位:m;
对式(17)进行求导可得:
(4)转向系统模型
车辆方向盘转角δs和车辆前轮转角δf的关系如下:
δs=is·δf
其中,δs为车辆方向盘转角,单位:rad;is为车辆转向系统传动比系数;
外部施加力矩T的表达式如下:
T=Td+ωTc
其中,ω为辅助强度系数;Tc为辅助力矩,单位:N·m;
车辆转向系统的转矩平衡方程如下:
其中,Js为车辆转向柱转动惯量,单位:kg·m2;bs为车辆转向柱阻尼比;
整理得到转向系统的状态空间方程如下:
其中,ηt为轮胎印迹常数,为车辆自身参数;
(4)人-车-路模型建立
人-车-路闭环系统的状态空间方程表达式如下:
式中,
C=[0 0 0 0 0 0 0 0 0 -lnear 1]T
其中,x为人-车-路系统状态向量;u为人-车-路系统控制量;A为人-车-路系统矩阵;B为人-车-路系统输入矩阵;C为人-车-路系统输出矩阵;D为人-车- 路系统曲率适配矩阵;y为人-车-路系统输出向量;
步骤二、确定辅助强度系数
辅助强度系数ω是通过道路危险参数Proad和辅助强度参数Pcon按照模糊逻辑得出的;
(1)道路危险参数Proad表达式如下:
其中,EA为道路危险参数Proad的调节系数,使道路危险参数Proad满足 Proad∈[0,1];车辆质心o当前位置与期望路径之间的偏差yvc的绝对值越大,道路危险参数Proad越接近于1,车辆危险程度就越高;
(2)辅助强度参数Pcon主要包括如下一致状态与非一致状态两种状态,表达式如下:
Tc·Td≥0时为一致状态,该状态下Pcon越接近于1,辅助力矩占比越大,辅助强度越强;Tc·Td<0时为非一致状态,该状态下Pcon越接近于-1,说明辅助力矩占比越大,辅助强度越强;
(3)采用模糊逻辑方法,获得辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon):
道路危险参数Proad范围为[0,1],将其划分为四个集合,即:s1表示安全,s2 表示较安全,d1表示较危险,d2表示危险,道路危险参数Proad的隶属度函数如下:
其中,A11、B11、C11、A12、B12、C12、A13、B13、C13、A14、B14和C14为常数;
辅助强度参数Pcon范围为[-1,1],在一致状态条件下为非负的,在非一致状态条件下为负的,将一致状态和非一致状态合在一起划分为5个集合,即:f2表示较大冲突,f1表示较小冲突,c1表示较小一致,c2表示中度一致,c3表示较大一致,辅助强度参数Pcon的隶属度函数如下:
其中,A21、B21、C21、A22、B22、C22、A23、B23、C23、A24、B24、C24、A25、B25和C25为常数;
辅助强度系数ω范围为[0,1],将其划分为四个集合,即:t1表示轻度辅助, t2表示中度辅助,t3表示较强辅助,以及t4表示高度辅助,辅助强度系数ω的隶属度函数如下:
其中,A31、B31、C31、A32、B32、C32、A33、B33、C33、A34、B34和C34为常数;
建立模糊规则如表1所示:
表1模糊规则
通过模糊规则与道路危险参数Proad的隶属度函数、辅助强度参数Pcon的隶属度函数和辅助强度系数ω的隶属度函数确定辅助强度系数ω关于道路危险参数 Proad和辅助强度参数Pcon的函数f(Proad,Pcon);
(4)辅助强度系数ω的实时确定
实时确定道路危险参数Proad和辅助强度参数Pcon,利用辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon)得到辅助强度系数ω;
步骤三、利用步骤二得到的辅助强度系数ω,采用模型预测控制方法进行基于驾驶状态预测的人机力矩协同控制器设计
(1)本方法的控制目标如下:
1)使车辆尽可能跟随期望路径,即使车辆质心o当前位置与期望路径之间的偏差yvc尽可能小,提高车辆行驶安全性;
2)人-车-路系统控制量u尽可能小,达到节能目的;
(2)基于驾驶状态预测的人机力矩协同控制器设计:
本方法做出如下假设:假设自动驾驶车辆在一个预测时域内保持恒速行驶,式(22)为人-车-路系统的连续模型,为用于基于驾驶状态预测的人机力矩协同控制算法的设计,需要将式(22)离散化,得到离散时间的人-车-路闭环系统模型如下:
x(k+1)=Acx(k)+Bcu(k)+Dcρ(k)
y(k)=Ccx(k) (25)
式中,其中,τ为积分变量;Ts为采样时间,单位:s;Ac为离散化后的人-车-路系统矩阵;Bc为离散化后的人-车-路系统输入矩阵;Cc为离散化后的人-车-路系统输出矩阵;Dc为离散化后的人-车-路道路曲率矩阵;
定义控制量序列Uk为:
假定预测时域为P步,控制时域为N步,且满足N≤P,同时假定控制时域之外的控制量保持不变,即u(k+N)=u(k+N+1)=…=u(k+P-1),可推导出预测时域P步内的驾驶状态预测方程如下:
其中,x(k+i)为k+i时刻的系统状态量,i=0,1,…,P;u(k+i)为k+i时刻的优化量,i=0,1,…,P-1;ρ(k+i)为k+i时刻的道路曲率,i=0,1,…,P-1;
预测时域P步内的输出预测方程如下:
yvc(k+1)=Ccx(k+1)
=Cc(Acx(k)+Bcu(k)+Dcρ(k))
=CcAcx(k)+CcBcu(k)+CcDcρ(k)
其中,yvc(k+i)为k+i时刻的系统输出量,i=0,1,…,P;
于是可以得到控制器目标函数如下:
其中,J为控制器的目标函数;Γ1为路径偏差权重系数;Γ2为控制量权重系数;
同时控制器还应满足一定的执行机构约束和安全性约束如下:
综上所述,得基于驾驶状态预测的人机力矩协同转向控制方法的约束优化问题如下:
满足:x(k+i+1)=Acx(k+i)+Bcu(k+i)+Dcρ(k+i)
-1≤yvc(k+i)≤1
-60≤u(k+i)≤60
求解上述约束优化问题,得k时刻优化解u(k);
步骤四、确定驾驶员引导系数
定义驾驶员输出力矩为T'd,单位:N·m;
(1)一致驾驶负担占比α1的表达式如下:
α1越接近于1,驾驶员输出力矩T'd越大,驾驶负担越重;
(2)冲突驾驶负担占比α2的表达式如下:
α2越接近于-1,驾驶员误操作程度越大,驾驶负担越重;
(3)抑制驾驶负担占比α3的表达式如下:
α3越接近于-1,驾驶员输出力矩T'd越大,驾驶负担越重;
(4)驾驶员引导系数拟合:
根据上面的定义,可知每个时刻驾驶员与控制器之间的关系必然在这三种关系中的一种,为了刻画三种关系与驾驶员引导系数α之间的关系,按照引导趋势,可以刻画出驾驶员引导系数α如下:
其中,c为驾驶员引导系数α的比例系数,i=1或2或3;
驾驶员引导系数α的最大值为1,代表着驾驶员按照自己原来的想法输出力矩;驾驶员引导系数α逐渐减小到0,代表着驾驶员在原有输出意愿上减小相应的倍数,驾驶负担减轻;驾驶员引导系数α在[0,1]范围内为在人机一致情况下对驾驶员进行引导,使驾驶员引导系数α逐渐减小到0,驾驶员输出力矩T'd逐渐减小,驾驶负担减轻;驾驶员引导系数α在[-1,0]的情况下,为在人机冲突或抑制的情况下对驾驶员进行引导,使驾驶员引导系数α逐渐减小到0,驾驶员输出力矩T'd逐渐减小,冲突程度或抑制程度减轻;
车辆转向系统根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂的神经肌肉环节,驾驶员根据上一时刻反馈效果调节当前时刻驾驶员输出力矩T'd;
步骤五、选取控制量并完成控制,选取控制量u'如下:
u'=T'd+u(k) (36)
将控制量u'作用于车辆转向系统,并根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂,对驾驶员进行引导,到下一时刻,根据当前人-车-路状态重新求解基于驾驶状态预测的人机力矩协同转向控制方法的约束优化问题,选取控制量u'作用于车辆转向系统,并根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂,对驾驶员进行引导,如此往复,实现滚动优化控制。
与现有技术相比本发明的有益效果是:
1、本发明使车辆更好跟随期望路径,提高路径跟踪精度。
2、本发明通过改变辅助强度系数,减少了人机之间的冲突。
3、本发明通过对驾驶员引导,减轻了驾驶员驾驶负担。
附图说明
图1为本发明所述的一种基于驾驶状态预测的人机力矩协同转向控制方法流程图。
图2为本方法中的两点预瞄驾驶员模型示意图。
图3为本方法中的二自由度车辆模型示意图。
图4为本方法中的路径跟踪模型示意图。
图5为本方法中的道路危险参数隶属度函数示意图。
图6为本方法中的辅助强度隶属度函数示意图。
图7为本方法中的辅助强系数度隶属度函数示意图。
图8为本方法中的辅助强度系数关于道路危险参数和辅助强度的函数的示意图。
图9为本方法中的驾驶员引导系数函数图。
具体实施方式
下面结合附图对本发明作详细的描述:
一种基于驾驶状态预测的人机力矩协同转向控制方法,如图1所示,通过建立人-车-路模型实现对驾驶状态的预测,基于人-车-路模型和模型预测控制方法设计基于驾驶状态预测的人机力矩协同转向控制器,为了提高人机一致性,在建立人-车-路模型时引入辅助强度系数,并通过模糊逻辑方法实时确定辅助强度系数;为了进一步减轻驾驶负担,对驾驶员引导系数进行拟合并根据驾驶员引导系数对驾驶员进行引导,减小驾驶员输出力矩,其特征在于,本方法的步骤如下:
步骤一、建立人-车-路的简化模型
建立地面坐标系,原点O固结于当前时刻车辆质心o所处位置,X轴指向当前时刻车身正前方,X轴沿逆时针方向旋转90度的方向为Y轴正方向;
建立车身坐标系,原点与车辆质心o重合,x轴指向车身正前方,x轴沿逆时针方向旋转90度为y轴正方向,z轴指向车身正上方并垂直于x轴和y轴;
(1)驾驶员模型建立
两点预瞄驾驶员模型如图2所示,该模型认为驾驶员在实际转向过程中,首先通过视觉系统获取前方的道路信息,结合远近道路的两个区域的道路信息,远点F作为预测点,反应未来要达到的大致方向,近点N作为补偿点,使驾驶员逐渐调整到期望轨迹上,之后视觉系统将得到的信息通过神经传递给大脑,大脑分析后决策出期望的驾驶员力矩,之后通过神经肌肉系统来完成执行,主要包括以下环节:
远预瞄角θfar为车辆质心o到远点F的方向与车身正前方的夹角,单位:rad;远预瞄距离lfar为车辆质心o到远点F的距离,单位:m;根据几何关系和运动学原理,得到远预瞄角θfar的表达式如下:
其中,Rv为车辆质心o轨迹的曲率半径,单位:m;r为车辆横摆角速度,单位:rad/s;vx为车辆坐标系下车辆纵向速度,单位:m/s;
近预瞄角θnear为车辆质心o到近点N的方向与车身正前方的夹角,单位:rad;近预瞄距离lnear为车辆质心o到近点N到车辆前进方向垂点的距离lnear,单位:m;横向偏移量yL为近点N到车辆前进方向的垂直距离,单位:m;由于近预瞄角θnear通常较小,得到近预瞄角θnear表达式如下:
当车辆在直线上行驶时远预瞄角θfar为零,当车辆在弯道上行驶时,根据道路弯曲程度来确定远预瞄距离lfar,也即确定远预瞄角θfar;
为了产生正比于远预瞄角θfar的驾驶员模型输出力矩Td,引入视觉超前控制环节,视觉超前控制环节的输入为θfar、输出为Tant,视觉超前控制环节的传递函数Ga(s)如下:
Ga(s)=Kα (3)
其中,Ka为远预瞄角θfar的比例增益,反应驾驶员对远预瞄角θfar的感知程度,本方法中选取Ka=22;
为了基于近预瞄角θnear生成与近预瞄距离lnear相关的纠正转向角,以确保驾驶员模型的路径跟踪精度,引入车道保持补偿控制环节,车道保持补偿控制环节的输入为θnear、输出为Tcom,车道保持补偿控制环节的传递函数Gc(s)如下:
其中,Kc为近预瞄角θnear的比例增益,反应驾驶员对近预瞄角θnear的感知程度,本方法中选取Kc=14;TL为驾驶员模型的超前时间常数,单位:s,本方法中选取TL=2.4;TI为驾驶员模型的滞后时间常数,单位:s,本方法中选取TI=0.2;
为了反映驾驶员感觉器官和神经系统处理信息的延时,引入延时环节进行等效,延时环节的输入为Tant+Tcom、输出为Tr,不同驾驶员的反应时间是不同的,取一次近似得到延时环节的传递函数GL(s)如下:
其中,τp为延时环节时间常数,单位:s,本方法中选取τp=0.04;
为了模拟驾驶员作用于转向系统而产生的肌肉运动的知觉部分,引入感知环节和动作环节两个子系统,感知环节的输入为δf、输出为Tf,动作环节的输入为Tf、输出为Tm,感知环节的传递函数Gk1(s)和动作环节的传递函数Gk2(s)如下:
其中,KD为感知环节的比例增益,本方法中选取KD=1;KG为动作环节的比例增益,本方法中选取KG=-0.63;T1为感知环节时间常数,单位:s,本方法中选取T1=2.5;Tk1为动作环节的超前时间常数,单位:s,本方法中选取Tk1=1.99; Tk2为动作环节的滞后时间常数,单位:s,本方法中选取Tk2=0.013;
驾驶员手臂输出的转矩作用于转向盘从而控制车辆实现车道保持,驾驶员手臂动力学环节的输入为Tr-Tm-Tf、输出为驾驶员模型输出力矩Td,驾驶员手臂动力学环节的传递函数Gnm(s)近似后如下:
其中,TN为驾驶员手臂动力学模型时间常数,单位:s,本方法中选取TN=0.11;
同时,为了实现驾驶员模型与自动驾驶控制器人机共驾合作控制,驾驶员模型将被集成到自动驾驶控制器设计过程中,从而获得驾驶员模型在驾驶行为上的预测,驾驶员模型可以等效为一个三输入[θnear θfar δf]、单输出Td的模型,由上式可得驾驶员模型的状态空间方程如下:
式中:
xd=[Td xd2 xd3 xd4 xd5]T
ud=[θfar θnear δf]T
Cd=[1 0 0 0 0]
其中,xd为驾驶员状态矩阵;Td为驾驶员模型输出力矩,单位:N·m; xd2、xd3、xd4和xd5为视觉超前控制环节、车道保持补偿控制环节、延时环节、感知环节、动作环节和驾驶员手臂动力学环节输入输出的线性组合,没有实际物理意义;Αd为驾驶员系统矩阵;Bd为驾驶员输入矩阵;Cd为驾驶员输出矩阵;ud为驾驶员控制量矩阵;yd为驾驶员输出矩阵;δf为车辆前轮转角,单位:rad;
(2)车量动力学模型建立
车辆动力学特性比较复杂,存在多种自由度模型,各种模型的精确度与自由度也存在很大差异,考虑到控制方案所需模型应满足对车辆转向特性的要求,同时利于控制器实现,所以本方法中车辆动力学模型采用如图3所示车辆二自由度模型;根据力矩和转矩平衡方程,得到车辆侧向速度vy和车辆横摆角速度r 表达式如下:
其中,m为车辆的质量,单位:kg;vy为车辆坐标系下车辆侧向速度,单位:m/s;vx为车辆坐标系下车辆纵向速度,单位:m/s;r为车辆横摆角速度,单位:rad/s;Fyf为车辆前轮侧向力,单位:N;Fyr为车辆后轮侧向力,单位: N;Iz为车辆绕z轴的转动惯量,单位:kg·m2;lf为车辆质心o到车辆前轴的距离,单位:m;lr为车辆质心o到车辆后轴的距离,单位:m;
本方法中进行小角度近似,认为车辆轮胎通常工作在线性区域,得到车辆前轮侧向力Fyf和车辆后轮侧向力Fyr如下:
其中,Cf为线性化的车辆前轮轮胎的侧偏刚度,单位:N/rad;Cr为线性化的车辆后轮轮胎的侧偏刚度,单位:N/rad;αf为车辆前轮胎侧偏角,单位: rad;αr为车辆后轮胎侧偏角,单位:rad;
车辆前轮胎侧偏角αf和车辆后轮胎侧偏角αr近似后如下:
整理可得线性二自由度车辆的状态空间方程如式(12):
(3)车辆运动学模型
vY为地面坐标系下车辆侧向速度,单位:m/s;vX为地面坐标系下车辆纵向速度,单位:m/s;地面坐标系下车辆侧向速度vY、地面坐标系下车辆纵向速度vX和车辆坐标系下车辆侧向速度vy、车辆坐标系下车辆纵向速度vx关系如下:
其中,ψ为车辆横摆角,单位:rad;
假设车辆横摆角ψ较小,如果车辆前轮胎侧偏角αf和车辆后轮胎侧偏角αr保持在正常工作范围内,可进一步假设vy远小于vx,得:
定义车辆横摆角偏差ψL如下:
ψL=ψ-ψd (15)
其中,ψd为期望的车辆横摆角,单位:rad;
路径跟踪模型如图4所示,为了跟踪期望路径,选取车辆横摆角偏差ψL与横向偏移量yL来进行建模,这两个量可以很好的反应车辆跟踪期望路径的状态;
其中,ρ为道路曲率,单位:1/m;
横向偏移量yL通过几何关系可以近似表示如下:
yL=yvc+lnearψL (17)
其中,yvc为车辆质心o当前位置与期望路径之间的偏差,单位:m;
对式(17)进行求导可得:
(4)转向系统模型
车辆方向盘转角δs和车辆前轮转角δf的关系如下:
δs=is·δf
其中,δs为车辆方向盘转角,单位:rad;is为车辆转向系统传动比系数;
外部施加力矩T的表达式如下:
T=Td+ωTc
其中,ω为辅助强度系数;Tc为辅助力矩,单位:N·m;
其中,Js为车辆转向柱转动惯量,单位:kg·m2;bs为车辆转向柱阻尼比;
整理得到转向系统的状态空间方程如下:
其中,ηt为轮胎印迹常数,为车辆自身参数;
(4)人-车-路模型建立
人-车-路闭环系统的状态空间方程表达式如下:
式中,
C=[0 0 0 0 0 0 0 0 0 -lnear 1]T
其中,x为人-车-路系统状态向量;u为人-车-路系统控制量;A为人-车-路系统矩阵;B为人-车-路系统输入矩阵;C为人-车-路系统输出矩阵;D为人-车- 路系统曲率适配矩阵;y为人-车-路系统输出向量;
步骤二、确定辅助强度系数
辅助强度系数ω是通过道路危险参数Proad和辅助强度参数Pcon按照模糊逻辑得出的;
(1)道路危险参数Proad表达式如下:
其中,EA为道路危险参数Proad的调节系数,使道路危险参数Proad满足 Proad∈[0,1];车辆质心o当前位置与期望路径之间的偏差yvc的绝对值越大,道路危险参数Proad越接近于1,车辆危险程度就越高;
(2)辅助强度参数Pcon主要包括如下一致状态与非一致状态两种状态,表达式如下:
Tc·Td≥0时为一致状态,该状态下Pcon越接近于1,辅助力矩占比越大,辅助强度越强;Tc·Td<0时为非一致状态,该状态下Pcon越接近于-1,说明辅助力矩占比越大,辅助强度越强;
(3)采用模糊逻辑方法,获得辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon):
道路危险参数Proad范围为[0,1],将其划分为四个集合,即:s1表示安全,s2 表示较安全,d1表示较危险,d2表示危险,道路危险参数Proad的隶属度函数图像如图5所示,道路危险参数Proad的隶属度函数如下:
其中,A11、B11、C11、A12、B12、C12、A13、B13、C13、A14、B14和C14为常数;
辅助强度参数Pcon范围为[-1,1],在一致状态条件下为非负的,在非一致状态条件下为负的,将一致状态和非一致状态合在一起划分为5个集合,即:f2表示较大冲突,f1表示较小冲突,c1表示较小一致,c2表示中度一致,c3表示较大一致,辅助强度参数Pcon的隶属度函数图像如图6所示,辅助强度参数Pcon的隶属度函数如下:
其中,A21、B21、C21、A22、B22、C22、A23、B23、C23、A24、B24、C24、A25、B25和C25为常数;
辅助强度系数ω范围为[0,1],将其划分为四个集合,即:t1表示轻度辅助, t2表示中度辅助,t3表示较强辅助,以及t4表示高度辅助,辅助强度系数ω的隶属度函数图像如图7所示,辅助强度系数ω的隶属度函数如下:
其中,A31、B31、C31、A32、B32、C32、A33、B33、C33、A34、B34和C34为常数;
建立模糊规则如表1所示:
表1模糊规则
通过模糊规则与道路危险参数Proad的隶属度函数、辅助强度参数Pcon的隶属度函数和辅助强度系数ω的隶属度函数确定辅助强度系数ω关于道路危险参数 Proad和辅助强度参数Pcon的函数f(Proad,Pcon),该函数图像如图8所示;
(5)辅助强度系数ω的实时确定
实时确定道路危险参数Proad和辅助强度参数Pcon,利用辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon)得到辅助强度系数ω;
步骤三、利用步骤二得到的辅助强度系数ω,采用模型预测控制方法进行基于驾驶状态预测的人机力矩协同控制器设计
(1)本方法的控制目标如下:
1)使车辆尽可能跟随期望路径,即使车辆质心o当前位置与期望路径之间的偏差yvc尽可能小,提高车辆行驶安全性;
2)人-车-路系统控制量u尽可能小,达到节能目的;
(2)基于驾驶状态预测的人机力矩协同控制器设计:
本方法做出如下假设:假设自动驾驶车辆在一个预测时域内保持恒速行驶,式(22)为人-车-路系统的连续模型,为用于基于驾驶状态预测的人机力矩协同控制算法的设计,需要将式(22)离散化,得到离散时间的人-车-路闭环系统模型如下:
x(k+1)=Acx(k)+Bcu(k)+Dcρ(k)
y(k)=Ccx(k) (25)
式中,其中,τ为积分变量;Ts为采样时间,单位:s;Ac为离散化后的人-车-路系统矩阵;Bc为离散化后的人-车-路系统输入矩阵;Cc为离散化后的人-车-路系统输出矩阵;Dc为离散化后的人-车-路道路曲率矩阵;
定义控制量序列Uk为:
假定预测时域为P步,控制时域为N步,且满足N≤P,同时假定控制时域之外的控制量保持不变,即u(k+N)=u(k+N+1)=…=u(k+P-1),可推导出预测时域P步内的驾驶状态预测方程如下:
其中,x(k+i)为k+i时刻的系统状态量,i=0,1,…,P;u(k+i)为k+i时刻的优化量,i=0,1,…,P-1;ρ(k+i)为k+i时刻的道路曲率,i=0,1,…,P-1;
预测时域P步内的输出预测方程如下:
yvc(k+1)=Ccx(k+1)
=Cc(Acx(k)+Bcu(k)+Dcρ(k))
=CcAcx(k)+CcBcu(k)+CcDcρ(k)
其中,yvc(k+i)为k+i时刻的系统输出量,i=0,1,…,P;
于是可以得到控制器目标函数如下:
其中,J为控制器的目标函数;Γ1为路径偏差权重系数;Γ2为控制量权重系数;
同时控制器还应满足一定的执行机构约束和安全性约束如下:
综上所述,得基于驾驶状态预测的人机力矩协同转向控制方法的约束优化问题如下:
满足:x(k+i+1)=Acx(k+i)+Bcu(k+i)+Dcρ(k+i)
-1≤yvc(k+i)≤1
-60≤u(k+i)≤60
求解上述约束优化问题,得k时刻优化解u(k);
步骤四、确定驾驶员引导系数
定义驾驶员输出力矩为T'd,单位:N·m;
(1)一致驾驶负担占比α1的表达式如下:
α1越接近于1,驾驶员输出力矩T'd越大,驾驶负担越重;
(2)冲突驾驶负担占比α2的表达式如下:
α2越接近于-1,驾驶员误操作程度越大,驾驶负担越重;
(3)抑制驾驶负担占比α3的表达式如下:
α3越接近于-1,驾驶员输出力矩T'd越大,驾驶负担越重;
(4)驾驶员引导系数拟合:
根据上面的定义,可知每个时刻驾驶员与控制器之间的关系必然在这三种关系中的一种,为了刻画三种关系与驾驶员引导系数α之间的关系,按照引导趋势,可以刻画出驾驶员引导系数α如下:
其中,c为驾驶员引导系数α的比例系数,i=1或2或3;
驾驶员引导系数图像如图9所示,驾驶员引导系数α的最大值为1,代表着驾驶员按照自己原来的想法输出力矩;驾驶员引导系数α逐渐减小到0,代表着驾驶员在原有输出意愿上减小相应的倍数,驾驶负担减轻;驾驶员引导系数α在 [0,1]范围内为在人机一致情况下对驾驶员进行引导,使驾驶员引导系数α逐渐减小到0,驾驶员输出力矩T'd逐渐减小,驾驶负担减轻;驾驶员引导系数α在[-1,0] 的情况下,为在人机冲突或抑制的情况下对驾驶员进行引导,使驾驶员引导系数α逐渐减小到0,驾驶员输出力矩T'd逐渐减小,冲突程度或抑制程度减轻;
车辆转向系统根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂的神经肌肉环节,驾驶员根据上一时刻反馈效果调节当前时刻驾驶员输出力矩T'd;
步骤五、选取控制量并完成控制,选取控制量u'如下:
u'=T'd+u(k) (36)
将控制量u'作用于车辆转向系统,并根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂,对驾驶员进行引导,到下一时刻,根据当前人-车-路状态重新求解基于驾驶状态预测的人机力矩协同转向控制方法的约束优化问题,选取控制量u'作用于车辆转向系统,并根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂,对驾驶员进行引导,如此往复,实现滚动优化控制。
Claims (1)
1.一种基于驾驶状态预测的人机力矩协同转向控制方法,通过建立人-车-路模型实现对驾驶状态的预测,基于人-车-路模型和模型预测控制方法设计基于驾驶状态预测的人机力矩协同转向控制器,为了提高人机一致性,在建立人-车-路模型时引入辅助强度系数,并通过模糊逻辑方法实时确定辅助强度系数;为了进一步减轻驾驶负担,对驾驶员引导系数进行拟合并根据驾驶员引导系数对驾驶员进行引导,减小驾驶员输出力矩,其特征在于,本方法的步骤如下:
步骤一、建立人-车-路的简化模型
建立地面坐标系,原点O固结于当前时刻车辆质心o所处位置,X轴指向当前时刻车身正前方,X轴沿逆时针方向旋转90度的方向为Y轴正方向;
建立车身坐标系,原点与车辆质心o重合,x轴指向车身正前方,x轴沿逆时针方向旋转90度为y轴正方向,z轴指向车身正上方并垂直于x轴和y轴;
(1)驾驶员模型建立
两点预瞄驾驶员模型结合远近道路的两个区域的道路信息,远点F作为预测点,反应未来要达到的大致方向,近点N作为补偿点,使驾驶员逐渐调整到期望轨迹上,主要包括以下环节:
远预瞄角θfar为车辆质心o到远点F的方向与车身正前方的夹角,单位:rad;远预瞄距离lfar为车辆质心o到远点F的距离,单位:m;根据几何关系和运动学原理,得到远预瞄角θfar的表达式如下:
其中,Rv为车辆质心o轨迹的曲率半径,单位:m;r为车辆横摆角速度,单位:rad/s;vx为车辆坐标系下车辆纵向速度,单位:m/s;
近预瞄角θnear为车辆质心o到近点N的方向与车身正前方的夹角,单位:rad;近预瞄距离lnear为车辆质心o到近点N到车辆前进方向垂点的距离lnear,单位:m;横向偏移量yL为近点N到车辆前进方向的垂直距离,单位:m;由于近预瞄角θnear通常较小,得到近预瞄角θnear表达式如下:
当车辆在直线上行驶时远预瞄角θfar为零,当车辆在弯道上行驶时,根据道路弯曲程度来确定远预瞄距离lfar,也即确定远预瞄角θfar;
为了产生正比于远预瞄角θfar的驾驶员模型输出力矩Td,引入视觉超前控制环节,视觉超前控制环节的输入为θfar、输出为Tant,视觉超前控制环节的传递函数Ga(s)如下:
Ga(s)=Kα (3)
其中,Ka为远预瞄角θfar的比例增益,反应驾驶员对远预瞄角θfar的感知程度,本方法中选取Ka=22;
为了基于近预瞄角θnear生成与近预瞄距离lnear相关的纠正转向角,以确保驾驶员模型的路径跟踪精度,引入车道保持补偿控制环节,车道保持补偿控制环节的输入为θnear、输出为Tcom,车道保持补偿控制环节的传递函数Gc(s)如下:
其中,Kc为近预瞄角θnear的比例增益,反应驾驶员对近预瞄角θnear的感知程度,本方法中选取Kc=14;TL为驾驶员模型的超前时间常数,单位:s,本方法中选取TL=2.4;TI为驾驶员模型的滞后时间常数,单位:s,本方法中选取TI=0.2;
为了反映驾驶员感觉器官和神经系统处理信息的延时,引入延时环节进行等效,延时环节的输入为Tant+Tcom、输出为Tr,不同驾驶员的反应时间是不同的,取一次近似得到延时环节的传递函数GL(s)如下:
其中,τp为延时环节时间常数,单位:s,本方法中选取τp=0.04;
为了模拟驾驶员作用于转向系统而产生的肌肉运动的知觉部分,引入感知环节和动作环节两个子系统,感知环节的输入为δf、输出为Tf,动作环节的输入为Tf、输出为Tm,感知环节的传递函数Gk1(s)和动作环节的传递函数Gk2(s)如下:
其中,KD为感知环节的比例增益,本方法中选取KD=1;KG为动作环节的比例增益,本方法中选取KG=-0.63;T1为感知环节时间常数,单位:s,本方法中选取T1=2.5;Tk1为动作环节的超前时间常数,单位:s,本方法中选取Tk1=1.99;Tk2为动作环节的滞后时间常数,单位:s,本方法中选取Tk2=0.013;
驾驶员手臂输出的转矩作用于转向盘从而控制车辆实现车道保持,驾驶员手臂动力学环节的输入为Tr-Tm-Tf、输出为驾驶员模型输出力矩Td,驾驶员手臂动力学环节的传递函数Gnm(s)近似后如下:
其中,TN为驾驶员手臂动力学模型时间常数,单位:s,本方法中选取TN=0.11;
同时,为了实现驾驶员模型与自动驾驶控制器人机共驾合作控制,驾驶员模型将被集成到自动驾驶控制器设计过程中,从而获得驾驶员模型在驾驶行为上的预测,驾驶员模型可以等效为一个三输入[θnear θfar δf]、单输出Td的模型,由上式可得驾驶员模型的状态空间方程如下:
式中:
xd=[Td xd2 xd3 xd4 xd5]T
ud=[θfar θnear δf]T
Cd=[1 0 0 0 0]
其中,xd为驾驶员状态矩阵;Td为驾驶员模型输出力矩,单位:N·m;xd2、xd3、xd4和xd5为视觉超前控制环节、车道保持补偿控制环节、延时环节、感知环节、动作环节和驾驶员手臂动力学环节输入输出的线性组合,没有实际物理意义;Αd为驾驶员系统矩阵;Bd为驾驶员输入矩阵;Cd为驾驶员输出矩阵;ud为驾驶员控制量矩阵;yd为驾驶员输出矩阵;δf为车辆前轮转角,单位:rad;
(2)车量动力学模型建立
本方法中车辆动力学模型采用车辆二自由度模型;根据力矩和转矩平衡方程,得到车辆侧向速度vy和车辆横摆角速度r表达式如下:
其中,m为车辆的质量,单位:kg;vy为车辆坐标系下车辆侧向速度,单位:m/s;vx为车辆坐标系下车辆纵向速度,单位:m/s;r为车辆横摆角速度,单位:rad/s;Fyf为车辆前轮侧向力,单位:N;Fyr为车辆后轮侧向力,单位:N;Iz为车辆绕z轴的转动惯量,单位:kg·m2;lf为车辆质心o到车辆前轴的距离,单位:m;lr为车辆质心o到车辆后轴的距离,单位:m;
本方法中进行小角度近似,认为车辆轮胎通常工作在线性区域,得到车辆前轮侧向力Fyf和车辆后轮侧向力Fyr如下:
其中,Cf为线性化的车辆前轮轮胎的侧偏刚度,单位:N/rad;Cr为线性化的车辆后轮轮胎的侧偏刚度,单位:N/rad;αf为车辆前轮胎侧偏角,单位:rad;αr为车辆后轮胎侧偏角,单位:rad;
车辆前轮胎侧偏角αf和车辆后轮胎侧偏角αr近似后如下:
整理可得线性二自由度车辆的状态空间方程如式(12):
(3)车辆运动学模型
vY为地面坐标系下车辆侧向速度,单位:m/s;vX为地面坐标系下车辆纵向速度,单位:m/s;地面坐标系下车辆侧向速度vY、地面坐标系下车辆纵向速度vX和车辆坐标系下车辆侧向速度vy、车辆坐标系下车辆纵向速度vx关系如下:
其中,ψ为车辆横摆角,单位:rad;
假设车辆横摆角ψ较小,如果车辆前轮胎侧偏角αf和车辆后轮胎侧偏角αr保持在正常工作范围内,可进一步假设vy远小于vx,得:
定义车辆横摆角偏差ψL如下:
ψL=ψ-ψd (15)
其中,ψd为期望的车辆横摆角,单位:rad;
为了跟踪期望路径,选取车辆横摆角偏差ψL与横向偏移量yL来进行建模,这两个量可以很好的反应车辆跟踪期望路径的状态;
其中,ρ为道路曲率,单位:1/m;
横向偏移量yL通过几何关系可以近似表示如下:
yL=yvc+lnearψL (17)
其中,yvc为车辆质心o当前位置与期望路径之间的偏差,单位:m;
对式(17)进行求导可得:
(4)转向系统模型
车辆方向盘转角δs和车辆前轮转角δf的关系如下:
δs=is·δf
其中,δs为车辆方向盘转角,单位:rad;is为车辆转向系统传动比系数;
外部施加力矩T的表达式如下:
T=Td+ωTc
其中,ω为辅助强度系数;Tc为辅助力矩,单位:N·m;
车辆转向系统的转矩平衡方程如下:
其中,Js为车辆转向柱转动惯量,单位:kg·m2;bs为车辆转向柱阻尼比;
整理得到转向系统的状态空间方程如下:
其中,ηt为轮胎印迹常数,为车辆自身参数;
(4)人-车-路模型建立
人-车-路闭环系统的状态空间方程表达式如下:
式中,
C=[0 0 0 0 0 0 0 0 0 -lnear 1]T
其中,x为人-车-路系统状态向量;u为人-车-路系统控制量;A为人-车-路系统矩阵;B为人-车-路系统输入矩阵;C为人-车-路系统输出矩阵;D为人-车-路系统曲率适配矩阵;y为人-车-路系统输出向量;
步骤二、确定辅助强度系数
辅助强度系数ω是通过道路危险参数Proad和辅助强度参数Pcon按照模糊逻辑得出的;
(1)道路危险参数Proad表达式如下:
其中,EA为道路危险参数Proad的调节系数,使道路危险参数Proad满足Proad∈[0,1];车辆质心o当前位置与期望路径之间的偏差yvc的绝对值越大,道路危险参数Proad越接近于1,车辆危险程度就越高;
(2)辅助强度参数Pcon主要包括如下一致状态与非一致状态两种状态,表达式如下:
Tc·Td≥0时为一致状态,该状态下Pcon越接近于1,辅助力矩占比越大,辅助强度越强;Tc·Td<0时为非一致状态,该状态下Pcon越接近于-1,说明辅助力矩占比越大,辅助强度越强;
(3)采用模糊逻辑方法,获得辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon):
道路危险参数Proad范围为[0,1],将其划分为四个集合,即:s1表示安全,s2表示较安全,d1表示较危险,d2表示危险,道路危险参数Proad的隶属度函数如下:
其中,A11、B11、C11、A12、B12、C12、A13、B13、C13、A14、B14和C14为常数;
辅助强度参数Pcon范围为[-1,1],在一致状态条件下为非负的,在非一致状态条件下为负的,将一致状态和非一致状态合在一起划分为5个集合,即:f2表示较大冲突,f1表示较小冲突,c1表示较小一致,c2表示中度一致,c3表示较大一致,辅助强度参数Pcon的隶属度函数如下:
其中,A21、B21、C21、A22、B22、C22、A23、B23、C23、A24、B24、C24、A25、B25和C25为常数;
辅助强度系数ω范围为[0,1],将其划分为四个集合,即:t1表示轻度辅助,t2表示中度辅助,t3表示较强辅助,以及t4表示高度辅助,辅助强度系数ω的隶属度函数如下:
其中,A31、B31、C31、A32、B32、C32、A33、B33、C33、A34、B34和C34为常数;
建立模糊规则如表1所示:
表1 模糊规则
通过模糊规则与道路危险参数Proad的隶属度函数、辅助强度参数Pcon的隶属度函数和辅助强度系数ω的隶属度函数确定辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon);
(4)辅助强度系数ω的实时确定
实时确定道路危险参数Proad和辅助强度参数Pcon,利用辅助强度系数ω关于道路危险参数Proad和辅助强度参数Pcon的函数f(Proad,Pcon)得到辅助强度系数ω;
步骤三、利用步骤二得到的辅助强度系数ω,采用模型预测控制方法进行基于驾驶状态预测的人机力矩协同控制器设计
(1)本方法的控制目标如下:
1)使车辆尽可能跟随期望路径,即使车辆质心o当前位置与期望路径之间的偏差yvc尽可能小,提高车辆行驶安全性;
2)人-车-路系统控制量u尽可能小,达到节能目的;
(2)基于驾驶状态预测的人机力矩协同控制器设计:
本方法做出如下假设:假设自动驾驶车辆在一个预测时域内保持恒速行驶,式(22)为人-车-路系统的连续模型,为用于基于驾驶状态预测的人机力矩协同控制算法的设计,需要将式(22)离散化,得到离散时间的人-车-路闭环系统模型如下:
式中,其中,τ为积分变量;Ts为采样时间,单位:s;Ac为离散化后的人-车-路系统矩阵;Bc为离散化后的人-车-路系统输入矩阵;Cc为离散化后的人-车-路系统输出矩阵;Dc为离散化后的人-车-路道路曲率矩阵;
定义控制量序列Uk为:
假定预测时域为P步,控制时域为N步,且满足N≤P,同时假定控制时域之外的控制量保持不变,即u(k+N)=u(k+N+1)=…=u(k+P-1),可推导出预测时域P步内的驾驶状态预测方程如下:
其中,x(k+i)为k+i时刻的系统状态量,i=0,1,…,P;u(k+i)为k+i时刻的优化量,i=0,1,…,P-1;ρ(k+i)为k+i时刻的道路曲率,i=0,1,…,P-1;
预测时域P步内的输出预测方程如下:
其中,yvc(k+i)为k+i时刻的系统输出量,i=0,1,…,P;
于是可以得到控制器目标函数如下:
其中,J为控制器的目标函数;Γ1为路径偏差权重系数;Γ2为控制量权重系数;
同时控制器还应满足一定的执行机构约束和安全性约束如下:
综上所述,得基于驾驶状态预测的人机力矩协同转向控制方法的约束优化问题如下:
满足:x(k+i+1)=Acx(k+i)+Bcu(k+i)+Dcρ(k+i)
-1≤yvc(k+i)≤1
-60≤u(k+i)≤60
求解上述约束优化问题,得k时刻优化解u(k);
步骤四、确定驾驶员引导系数
定义驾驶员输出力矩为T′d,单位:N·m;
(1)一致驾驶负担占比α1的表达式如下:
α1越接近于1,驾驶员输出力矩T′d越大,驾驶负担越重;
(2)冲突驾驶负担占比α2的表达式如下:
α2越接近于-1,驾驶员误操作程度越大,驾驶负担越重;
(3)抑制驾驶负担占比α3的表达式如下:
α3越接近于-1,驾驶员输出力矩T′d越大,驾驶负担越重;
(4)驾驶员引导系数拟合:
根据上面的定义,可知每个时刻驾驶员与控制器之间的关系必然在这三种关系中的一种,为了刻画三种关系与驾驶员引导系数α之间的关系,按照引导趋势,可以刻画出驾驶员引导系数α如下:
其中,c为驾驶员引导系数α的比例系数,i=1或2或3;
驾驶员引导系数α的最大值为1,代表着驾驶员按照自己原来的想法输出力矩;驾驶员引导系数α逐渐减小到0,代表着驾驶员在原有输出意愿上减小相应的倍数,驾驶负担减轻;驾驶员引导系数α在[0,1]范围内为在人机一致情况下对驾驶员进行引导,使驾驶员引导系数α逐渐减小到0,驾驶员输出力矩T′d逐渐减小,驾驶负担减轻;驾驶员引导系数α在[-1,0]的情况下,为在人机冲突或抑制的情况下对驾驶员进行引导,使驾驶员引导系数α逐渐减小到0,驾驶员输出力矩T′d逐渐减小,冲突程度或抑制程度减轻;
车辆转向系统根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂的神经肌肉环节,驾驶员根据上一时刻反馈效果调节当前时刻驾驶员输出力矩T′d;
步骤五、选取控制量并完成控制,选取控制量u'如下:
u'=T′d+u(k) (36)
将控制量u'作用于车辆转向系统,并根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂,对驾驶员进行引导,到下一时刻,根据当前人-车-路状态重新求解基于驾驶状态预测的人机力矩协同转向控制方法的约束优化问题,选取控制量u'作用于车辆转向系统,并根据驾驶员引导系数α产生相应的反馈效果作用于驾驶员手臂,对驾驶员进行引导,如此往复,实现滚动优化控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010588218.9A CN111688704B (zh) | 2020-06-24 | 2020-06-24 | 一种基于驾驶状态预测的人机力矩协同控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010588218.9A CN111688704B (zh) | 2020-06-24 | 2020-06-24 | 一种基于驾驶状态预测的人机力矩协同控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111688704A true CN111688704A (zh) | 2020-09-22 |
CN111688704B CN111688704B (zh) | 2021-05-25 |
Family
ID=72483304
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010588218.9A Active CN111688704B (zh) | 2020-06-24 | 2020-06-24 | 一种基于驾驶状态预测的人机力矩协同控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111688704B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112096852A (zh) * | 2020-09-27 | 2020-12-18 | 吉林大学 | 一种超多挡位自动变速器换挡规律设计方法 |
CN112319610A (zh) * | 2020-10-14 | 2021-02-05 | 华南理工大学 | 一种智能汽车的人机共享转向控制方法 |
CN112606843A (zh) * | 2020-12-24 | 2021-04-06 | 江苏大学 | 一种基于Lyapunov-MPC技术的智能车辆路径跟踪控制方法 |
CN113553726A (zh) * | 2021-08-06 | 2021-10-26 | 吉林大学 | 一种冰雪环境下的主从博弈型人机协同转向控制方法 |
CN113619563A (zh) * | 2021-09-06 | 2021-11-09 | 厦门大学 | 基于人机共享的智能电动汽车横向控制系统及方法 |
CN113673076A (zh) * | 2021-07-09 | 2021-11-19 | 华南理工大学 | 一种适用于海洋浮式结构的动力响应求解方法 |
CN113911140A (zh) * | 2021-11-24 | 2022-01-11 | 无锡物联网创新中心有限公司 | 一种基于非合作博弈的人机共驾控制方法及相关装置 |
WO2022062452A1 (zh) * | 2020-09-23 | 2022-03-31 | 北京理工大学 | 自动驾驶车辆路径规划与路径跟踪集成控制方法及系统 |
CN114675742A (zh) * | 2022-05-04 | 2022-06-28 | 吉林大学 | 一种面向高度自动驾驶的人机决策逻辑在线校验方法 |
WO2022236754A1 (zh) * | 2021-05-13 | 2022-11-17 | 吉林大学 | 一种多驾驶员在环驾驶试验平台 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150266455A1 (en) * | 2013-12-06 | 2015-09-24 | Christopher Kenneth Wilson | Systems and Methods for Building Road Models, Driver Models, and Vehicle Models and Making Predictions Therefrom |
CN104977933A (zh) * | 2015-07-01 | 2015-10-14 | 吉林大学 | 一种自主驾驶车辆的区域型路径跟踪控制方法 |
CN107323457A (zh) * | 2017-07-06 | 2017-11-07 | 吉林大学 | 一种人机协同的共享转向控制方法 |
CN107804315A (zh) * | 2017-11-07 | 2018-03-16 | 吉林大学 | 一种考虑驾驶权实时分配的人车协同转向控制方法 |
CN107856737A (zh) * | 2017-11-06 | 2018-03-30 | 吉林大学 | 一种基于危险程度变权重的人机协同转向控制方法 |
CN110096748A (zh) * | 2019-04-01 | 2019-08-06 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
-
2020
- 2020-06-24 CN CN202010588218.9A patent/CN111688704B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150266455A1 (en) * | 2013-12-06 | 2015-09-24 | Christopher Kenneth Wilson | Systems and Methods for Building Road Models, Driver Models, and Vehicle Models and Making Predictions Therefrom |
CN104977933A (zh) * | 2015-07-01 | 2015-10-14 | 吉林大学 | 一种自主驾驶车辆的区域型路径跟踪控制方法 |
CN107323457A (zh) * | 2017-07-06 | 2017-11-07 | 吉林大学 | 一种人机协同的共享转向控制方法 |
CN107856737A (zh) * | 2017-11-06 | 2018-03-30 | 吉林大学 | 一种基于危险程度变权重的人机协同转向控制方法 |
CN107804315A (zh) * | 2017-11-07 | 2018-03-16 | 吉林大学 | 一种考虑驾驶权实时分配的人车协同转向控制方法 |
CN110096748A (zh) * | 2019-04-01 | 2019-08-06 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11634146B2 (en) | 2020-09-23 | 2023-04-25 | Beijing Institute Of Technology | Method and system for integrated path planning and path tracking control of autonomous vehicle |
WO2022062452A1 (zh) * | 2020-09-23 | 2022-03-31 | 北京理工大学 | 自动驾驶车辆路径规划与路径跟踪集成控制方法及系统 |
CN112096852B (zh) * | 2020-09-27 | 2021-05-25 | 吉林大学 | 一种超多挡位自动变速器换挡规律设计方法 |
CN112096852A (zh) * | 2020-09-27 | 2020-12-18 | 吉林大学 | 一种超多挡位自动变速器换挡规律设计方法 |
CN112319610A (zh) * | 2020-10-14 | 2021-02-05 | 华南理工大学 | 一种智能汽车的人机共享转向控制方法 |
CN112319610B (zh) * | 2020-10-14 | 2021-11-19 | 华南理工大学 | 一种智能汽车的人机共享转向控制方法 |
CN112606843A (zh) * | 2020-12-24 | 2021-04-06 | 江苏大学 | 一种基于Lyapunov-MPC技术的智能车辆路径跟踪控制方法 |
WO2022236754A1 (zh) * | 2021-05-13 | 2022-11-17 | 吉林大学 | 一种多驾驶员在环驾驶试验平台 |
CN113673076A (zh) * | 2021-07-09 | 2021-11-19 | 华南理工大学 | 一种适用于海洋浮式结构的动力响应求解方法 |
CN113553726B (zh) * | 2021-08-06 | 2022-07-05 | 吉林大学 | 一种冰雪环境下的主从博弈型人机协同转向控制方法 |
CN113553726A (zh) * | 2021-08-06 | 2021-10-26 | 吉林大学 | 一种冰雪环境下的主从博弈型人机协同转向控制方法 |
CN113619563B (zh) * | 2021-09-06 | 2022-08-30 | 厦门大学 | 基于人机共享的智能电动汽车横向控制系统及方法 |
CN113619563A (zh) * | 2021-09-06 | 2021-11-09 | 厦门大学 | 基于人机共享的智能电动汽车横向控制系统及方法 |
CN113911140B (zh) * | 2021-11-24 | 2022-09-27 | 无锡物联网创新中心有限公司 | 一种基于非合作博弈的人机共驾控制方法及相关装置 |
CN113911140A (zh) * | 2021-11-24 | 2022-01-11 | 无锡物联网创新中心有限公司 | 一种基于非合作博弈的人机共驾控制方法及相关装置 |
CN114675742A (zh) * | 2022-05-04 | 2022-06-28 | 吉林大学 | 一种面向高度自动驾驶的人机决策逻辑在线校验方法 |
CN114675742B (zh) * | 2022-05-04 | 2022-11-01 | 吉林大学 | 一种面向高度自动驾驶的人机决策逻辑在线校验方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111688704B (zh) | 2021-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111688704B (zh) | 一种基于驾驶状态预测的人机力矩协同控制方法 | |
CN109969181B (zh) | 一种车道偏离辅助系统及其车道偏离辅助方法 | |
CN108216231B (zh) | 一种基于转向和制动可拓联合的车道偏离辅助控制方法 | |
CN110329255B (zh) | 一种基于人机协同策略的车道偏离辅助控制方法 | |
CN114185272B (zh) | 一种基于模型预测控制的具有预览特性的自适应速度智能车辆路径跟踪方法 | |
CN108732921B (zh) | 一种自动驾驶汽车横向可拓预瞄切换控制方法 | |
CN107856737B (zh) | 一种基于危险程度变权重的人机协同转向控制方法 | |
CN109164814B (zh) | 面向高速公路场景的自动驾驶控制系统 | |
CN109177974A (zh) | 一种智能汽车的人机共驾型车道保持辅助方法 | |
CN111152834A (zh) | 一种基于阿克曼转向修正的电动汽车电子差速控制方法 | |
CN111338353A (zh) | 一种动态驾驶环境下智能车辆变道轨迹规划方法 | |
CN112109732A (zh) | 一种智能驾驶自适应曲线预瞄方法 | |
Liu et al. | Driver-automation shared steering control for highly automated vehicles | |
CN109017759A (zh) | 期望路径车辆横摆控制方法 | |
CN107323457A (zh) | 一种人机协同的共享转向控制方法 | |
Xueyun et al. | Robust controller design for trajectory tracking of autonomous vehicle | |
CN113553726B (zh) | 一种冰雪环境下的主从博弈型人机协同转向控制方法 | |
CN113311698B (zh) | 车道保持控制方法、控制装置和车辆 | |
CN113183953B (zh) | 基于分布式驱动底盘的车辆碰后主动安全控制方法及系统 | |
CN117657154A (zh) | 一种面向复杂工况自适应的智能车混合控制系统及方法 | |
CN114537517B (zh) | 一种提升操稳性能的线控转向系统自适应反推控制方法 | |
Wang et al. | Lane Departure assistance coordinated control system for in-wheel motor drive vehicles based on dynamic extension boundary decision | |
Yuan et al. | Research on emergency collision avoidance system of man-machine cooperative driving vehicles based on additional yaw moment control | |
CN114312751A (zh) | 一种4wid/s电动汽车变角传动比控制方法 | |
Liu et al. | Driver-in-the-loop handling stability control of 4WID-EV |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |