CN107804315A - 一种考虑驾驶权实时分配的人车协同转向控制方法 - Google Patents
一种考虑驾驶权实时分配的人车协同转向控制方法 Download PDFInfo
- Publication number
- CN107804315A CN107804315A CN201711082359.8A CN201711082359A CN107804315A CN 107804315 A CN107804315 A CN 107804315A CN 201711082359 A CN201711082359 A CN 201711082359A CN 107804315 A CN107804315 A CN 107804315A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mtr
- vehicle
- 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 42
- 238000005457 optimization Methods 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000006073 displacement reaction Methods 0.000 claims description 15
- 230000001133 acceleration Effects 0.000 claims description 9
- 230000001953 sensory effect Effects 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 3
- 238000009941 weaving Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 6
- 230000006399 behavior Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 230000007423 decrease Effects 0.000 description 2
- 230000007774 longterm Effects 0.000 description 2
- 208000019914 Mental Fatigue Diseases 0.000 description 1
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000003967 crop rotation Methods 0.000 description 1
- 230000007850 degeneration Effects 0.000 description 1
- 230000002045 lasting effect Effects 0.000 description 1
- 230000035479 physiological effects, processes and functions Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
-
- 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
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明为解决人车协同驾驶过程中驾驶员和车辆自动驾驶控制器之间驾驶权分配问题,提出了一种考虑驾驶权实时分配的人车协同转向控制方法,具体过程为:步骤一、建立车辆动力学模型与车辆运动学模型;步骤二、建立车辆自动驾驶控制器;步骤三、建立人车共驾***模型;步骤四、采用模型预测方法进行人车共驾***控制器设计;步骤五、进行驾驶权分配并计算控制量,执行控制量,实现驾驶员与车辆自动驾驶控制器之间的协同控制车辆转向的过程;本方法在车辆自动驾驶控制器和驾驶员共同驾驶汽车的情况下,能够在线实时优化分配车辆自动驾驶控制器与驾驶员的转向驾驶权,实现车辆自动驾驶控制器和驾驶员共同完成车辆转向操作。
Description
技术领域
本发明属于汽车驾驶控制领域,涉及一种人车协同驾驶策略,更加具体的来讲,涉及一种考虑驾驶权实时分配的人车协同转向控制方法。
背景技术
日趋密集的道路交通不断加重驾驶人的工作负荷,长时间的高负荷驾驶持续占用驾驶人认知生理资源,进而导致精神疲劳并引起驾驶能力下降,易酿成严重交通事故。智能驾驶是降低驾驶人工作负荷和提升车辆安全性的重要手段,其中一个发展方向是无人驾驶。然而,无人驾驶由于驾驶人完全脱离于控制环,易造成“过依赖”和“情景意识下降”等人因问题。全面实现无人驾驶是一个长期的过程,短期内实现的难度较大,因此驾驶人和智能***分享车辆的控制权也就是人车共驾在无人驾驶完全实现之前将长期存在。目前,人车共驾正逐步吸引国内外专家学者的密切关注,代表着智能汽车的新型发展方向。
现有人车共驾过程中驾驶员有个性化、模糊、退化和学习能力强的特点,智能***学习能力相对较差,应对未知工况能力十分薄弱,如何实现驾驶员和智能***的驾驶权的分配与融合是实现人车共驾必须解决的问题。
发明内容
本发明为解决人车协同驾驶过程中驾驶员和车辆自动驾驶控制器之间驾驶权分配问题,提出一种可以在线实时分配驾驶员和车辆自动驾驶控制器之间驾驶权的方法。
本发明所述的一种考虑驾驶权实时分配的人车协同转向控制方法,是采用如下技术方案实现的:
一种考虑驾驶权实时分配的人车协同转向控制方法,基于一种驾驶员和车辆自动驾驶控制器共同配合完成车辆转向控制的驾驶模式,该种模式下当驾驶员的驾驶行为不出现错误时,车辆自动驾驶控制器能够按照一定的比例帮助驾驶员分担一部分转向任务,减轻驾驶员负担,在驾驶员驾驶行为出现错误时,将驾驶员的驾驶权重减小甚至减少至零,由车辆自动驾驶控制器独立控制转向,其特征在于,本方法具体步骤如下:
步骤一、建立车辆动力学模型与车辆运动学模型:
建立大地坐标系:原点O固结于地面,X轴通常与车辆初始运动方向重合,X沿逆时针方向旋转90度为Y轴的正方向;
建立车辆坐标系:以车辆动力学模型中车辆质心o为坐标原点,沿着车辆前进的方向为x轴的正方向,x轴沿逆时针方向旋转90度为y轴的正方向建立坐标系;
用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系,并用二自由度车辆动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系,具体过程如下:
假定车辆是一个刚性体,车辆装置着四个不会发生形变的车轮,并以车辆前轮作为转向轮,根据车辆运动学方程以及车辆运动的几何关系得到车辆的运动学模型如式(1)所示:
式中xo为车辆质心o的纵向位移,单位m;yo为车辆质心o的侧向位移,单位m;v为车辆质心的速度,单位m/s;r为车辆的横摆角速度,单位rad/s;ψ为车辆的航向角,单位rad;β为车辆的质心侧偏角,单位rad;
考虑到实际道路的曲率通常很小,车辆在这段实际道路区域内行驶时航向角ψ同样可以认为是很小的,且实际上车辆的质心侧偏角β变化范围也很小,所以有:sin(ψ+β)≈ψ+β,cos(ψ+β)≈1,结合式(1)可以得到简化的车辆运动学模型,如式(2)所示:
本方法是通过控制车辆的前轮转角来实现路径跟踪的目的,并且认为车辆保持匀速状态行驶,所以只需要考虑车辆的侧向运动,根据牛顿第二定律与力矩平衡关系,可得到如式(3)所示的二自由度车辆动力学模型:
式中vx为车辆质心处的纵向速度,单位m/s;Fyf为车辆前轮侧向力,单位N;Fyr为车辆后轮侧向力,单位N;m为车辆的质量,单位kg;Iz为车辆绕z轴的转动惯量,单位kg·m2;a为车辆质心o到车辆前轴的距离,单位m;b为车辆质心o到车辆后轴的距离,单位m;δf为车辆前轮转角,单位rad;
车辆实际的前轮转角δf通常也很小,可以近似认为:cosδf≈1,sinδf≈0,因此对式(3)进行简化,简化后的二自由度车辆动力学模型如式(4)所示:
车辆侧向轮胎力未达到饱和时,车辆侧向轮胎力Fy与轮胎侧偏角α可近似看作呈线性关系如式(5)所示:
式中Cf为车辆前轮的轮胎侧偏刚度,单位N·rad;Cr为车辆后轮的轮胎侧偏刚度,单位N·rad;αf为车辆前轮的轮胎侧偏角,单位rad;αr为车辆后轮的轮胎侧偏角,单位rad;
在车辆坐标系下,前轮的轮胎侧偏角αf和后轮的轮胎侧偏角αr有如式(6)的关系:
结合式(4)、式(5)和式(6),整理可得二自由度车辆动力学模型如式(7)所示:
步骤二、建立车辆自动驾驶控制器:
根据车辆运动的特点,建立能够使车辆按照一定轨迹行驶的车辆自动驾驶控制器,车辆的运动服从阿克曼几何关系,车辆轨迹曲率与前轮转角成正比:
或
其中,δa为车辆自动驾驶控制器决策出的当前时刻前轮转角,单位rad;L为轴距,单位m;vax为大地坐标系下车辆纵向速度,单位m/s;R为车辆转弯半径,单位m;aay为车辆大地坐标系下的横向加速度,单位m/s2;
假设车辆始终沿着道路中心线行驶,道路中心线的方程为f(t),道路中心线f(t)在X方向的坐标是函数x(t),道路中心线f(t)在Y方向的坐标是函数y(t);设在瞬时to车辆在Y方向的坐标为yao、车辆在Y方向的加速度为aayo、在Y方向的速度为vayo以及车辆的合速度为vao,当前位置在X方向坐标为x(to);假设车辆自动驾驶控制器感知到车辆前方道路上的某一点,该点定义为预视点,车辆质心o与该预视点在X方向的距离定义为预视距离d,对应于预视距离d有预视时间T,预视时间T表示的是车辆从当前位置行驶到该预视点所需要的时间,则预视时间车辆自动驾驶控制器感知到的预视点在X方向坐标为x(to+T),车辆自动驾驶控制器此时选择一个前轮转角使车辆能够使在经过时间T后到达预视点,该前轮转角对应的车辆的轨迹曲率为这样经过时间T之后,在时刻to+T车辆的横向位移ya为:
根据最小误差原则,车辆自动驾驶控制器总是希望选择一个车辆的最优的轨迹曲率记为使得车辆在T时间内走过距离d到达x(to+T)后,其预视点在Y方向的坐标ya与x(to+T)处的中心线轨道在Y方向的坐标y(to+T)相一致,由式(9)以及运动学原理求得车辆在Y方向的最优加速度为和车辆的最优的轨迹曲率为:
将车辆最优的轨迹曲率带入式(8)则可得到车辆自动驾驶控制器决策出的当前时刻前轮转角δa为:
步骤三、建立人车共驾***模型:
驾驶员与车辆自动驾驶控制器共同驾驶车辆为人车共驾***,步骤三通过建立人车共驾***模型对人车共驾***进行描述,由步骤二建立的车辆自动驾驶控制器决策出的当前时刻前轮转角δa,驾驶员决策出的当前时刻前轮转角δh,通过求解出当前时刻的驾驶权重ε后再按照式(12)给出的比例关系进行分配:
δf=εδh+(1-ε)δa (12)
式中δa为车辆自动驾驶控制器决策出的当前时刻前轮转角,单位rad;δh为驾驶员决策出的当前时刻前轮转角,单位rad;
求解出当前时刻的驾驶权重ε后,车辆自动驾驶控制器决策出的当前时刻前轮转角δa和驾驶员决策出的当前时刻前轮转角δh再根据式(12)给出的比例关系进行分配得到当前时刻最终的前轮转角δf作为当前时刻最终的前轮转角控制量;
结合式(2)、式(7)、式(11)和式(12),由于侧向车速相对于纵向车速较小可以近似看作v≈vx,整理可得人车共驾***模型如式(13):
该人车共驾***模型选取车辆质心o的侧向位移yo作为人车共驾***模型的输出,同时选取驾驶权重ε作为人车共驾***模型的控制输入,选取状态向量x=[yo ψ β r]T,人车共驾***模型可被描述成如式(14)所示的状态空间形式:
其中A为***矩阵,表示***内部状态变量的关系;B为控制矩阵,表示输入变量如何控制状态变量;C为输出矩阵,表示输出变量如何反映状态;E为常数项矩阵;各个矩阵表达式如下:
C=[1 0 0 0];
步骤四、采用模型预测方法进行人车共驾***控制器设计:
以步骤三中的人车共驾***模型作为人车共驾***控制器设计的预测模型,驾驶权重ε作为人车共驾***控制器的控制输入,设k为当前时刻,认为车辆在预测时域内速度保持不变,且认为驾驶员决策出的当前时刻前轮转角δh在预测时域内同样保持不变,将式(14)的人车共驾***模型进行离散化得到式(15):
式中Cc=C,Ec=E,Ts为采样时间,单位s;
人车共驾***控制器采用的模型预测方法中预测时域为P,控制时域为N,且满足N≤P,控制时域之外的人车共驾***控制器的控制输入保持不变,通过式(15)可以推导出人车共驾***控制器状态预测方程如式(16):
推导出人车共驾***控制器输出预测方程如式(17):
同时定义预测时域P内每一时刻人车共驾***控制器控制输入ε的序列Uε(k)、预测时域P内驾驶员决策出的每一时刻前轮转角δh的序列R(k)、预测时域P内车辆自动驾驶控制器决策出的每一时刻前轮转角δa的序列Ua(k)、预测时域P内每一时刻控制输出yo的序列Uy(k)、预测时域P内每一时刻道路中心线横向坐标y的序列Ry(k)和预测时域P内车辆自动驾驶控制器决策出的每一时刻前轮转角和驾驶员决策出的每一时刻前轮转角按照比例分配得到的预测时域P内每一时刻最终的前轮转角δf的序列U(k),如式(18):
式中δh(k+i)为k+i时刻的驾驶员决策出的前轮转角,单位rad;δf(k+i)为预测时域内k+i时刻车辆自动驾驶控制器决策出的前轮转角和预测时域内驾驶员决策出的前轮转角按照式(12)分配得到的最终的前轮转角,即为人车共驾***控制器实际控制车辆的前轮转角,单位rad;x(k+i)为k+i时刻的人车共驾***控制器的状态向量;yo(k+i)为k+i时刻的人车共驾***控制器的输出,即车辆质心的侧向位置,单位m;y(k+i),i=1,…,P为期望道路区域中心线f(t)在Y方向坐标离散量,离散间隔为vax·Ts,单位m;式中,i=1,2,3…P;
人车共驾***控制器的控制目标是一方面让驾驶员感受到车辆按照自己的驾驶意图行驶,通过跟踪驾驶员决策出的前轮转角实现,如式(19):
J1=‖(U(k)-R(k))‖2 (19)
另一方面使车辆发生危险的概率最小,通过跟踪道路中心线实现,如式(20):
J2=‖(Uy(k)-Ry(k))‖2 (20)
同时为了保证车辆转向的平顺性,应该使人车共驾***控制器的控制量即车辆前轮转角尽可能的小,如式(21):
J3=‖(U(k)‖2 (21)
引入权重矩阵Γh、Γy和Γu对J1、J2和J3三个优化目标的权重进行调整,人车共驾***控制器的优化目标如式(22):
本方法中道路边界可以通过车辆的感知***实时获得,且车辆必须在道路边界内行驶,即车辆坐标不超出道路边界,通过对车辆侧向位置约束简化考虑,道路加上车辆一半的宽度可以得到车辆前轴质心的道路边界约束和车辆后轴质心的道路边界约束,式中lf(ψ+β)表示车辆当前质心侧偏角与横摆角所造成的前轴端点的侧向位移量,lr(ψ+β)表示车辆当前质心侧偏角与横摆角所造成的后轴端点的侧向位移量,车辆侧向位置约束满足如下式(23)的不等式关系:
式中fl(x)为通过车辆的感知***实时获得的前方可行道路区域的左边界;fr(x)为通过车辆的感知***实时获得的前方可行道路区域的右边界;w为车辆宽度,单位m;lf为车辆质心o到车辆前端点的距离,单位m;lr为车辆质心o到车辆后端点的距离,单位m;
人车共驾***控制器必须满足***约束如式(24):
式中Cψ=[0 1 0 0],Cβ=[0 0 1 0];fl(k+i)为预测时域内前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位m;fr(k+i)则为预测时域内前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位m;
步骤五、进行驾驶权分配并计算控制量完成控制:
根据步骤四中优化求解出的预测时域P内每一时刻控制输入ε的序列Uε(k)、预测时域内车辆自动驾驶控制器的决策出的每一时刻前轮转角δa的序列Ua(k)和预测时域内驾驶员决策出的每一时刻前轮转角δh的序列R(k),取Uε(k)中的第一个量作为驾驶权重,取预测时域内车辆自动驾驶控制器决策出的每一时刻前轮转角δa的序列Ua(k)中的第一个量作为车辆自动驾驶控制器决策出的当前时刻前轮转角,取预测时域内驾驶员决策出的每一时刻前轮转角δh的序列R(k)中的第一个量作为驾驶员决策出的当前时刻前轮转角,根据式(12)求得当前时刻最终的前轮转角如式(25):
δf=Uε(1)·R(1)+(1-Uε(1))·Ua(1) (25)
当前时刻最终的前轮转角δf作为最终控制量传给车辆,车辆通过相应的执行机构执行控制量δf,实现驾驶员与车辆自动驾驶控制器协同控制车辆转向的过程。
本发明的有益效果为:
1.本发明提出了一种基于驾驶权分配的人机协同转向方案,在车辆自动驾驶控制器和驾驶员共同驾驶汽车的情况下,能够在线实时分配车辆自动驾驶控制器与驾驶员的转向驾驶权,实现车辆自动驾驶控制器和驾驶员共同完成车辆转向操作;
2.本发明运用了模型预测控制方法进行车辆自动驾驶控制器与驾驶员的转向驾驶权优化分配;
3.本发明在车辆不发生危险的情况下,能够在车辆自动驾驶控制器和驾驶员共同驾驶车辆的过程中,使车辆运动能尽可能满足驾驶员驾驶意图。
附图说明:
图1为本发明所述的一种考虑驾驶权实时分配的人车协同转向控制方法的流程简图;
图2为本发明所述的一种考虑驾驶权实时分配的人车协同转向控制方法建立的车辆运动学模型示意图;
图3为本发明所述的一种考虑驾驶权实时分配的人车协同转向控制方法建立的二自由度车辆动力学模型示意图;
图4为本发明所述的一种考虑驾驶权实时分配的人车协同转向控制方法中车辆自动驾驶控制器示意图;
图5为本发明所述的一种考虑驾驶权实时分配的人车协同转向控制方法的实现过程示意图;
具体实施方式:
下面结合附图对本发明进行详细说明:
本发明提出一种在线实时分配驾驶员和车辆自动驾驶控制器之间驾驶权的方法,如图1所示,具体实施步骤如下:
步骤一、建立车辆动力学模型与车辆运动学模型:
建立大地坐标系:原点O固结于地面,X轴通常与车辆初始运动方向重合,X沿逆时针方向旋转90度为Y轴的正方向;
建立车辆坐标系:以车辆动力学模型中车辆质心o为坐标原点,沿着车辆前进的方向为x轴的正方向,x轴沿逆时针方向旋转90度为y轴的正方向建立坐标系;
用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系,并用二自由度车辆动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系,具体过程如下:
图2为车辆运动学模型示意图,假定车辆是一个刚性体,车辆装置着四个不会发生形变的车轮,并以车辆前轮作为转向轮,根据车辆运动学方程以及车辆运动的几何关系得到车辆的运动学模型如式(1)所示:
式中xo为车辆质心o的纵向位移,单位m;yo为车辆质心o的侧向位移,单位m;v为车辆质心的速度,单位m/s;r为车辆的横摆角速度,单位rad/s;ψ为车辆的航向角,单位rad;β为车辆的质心侧偏角,单位rad;
考虑到实际道路的曲率通常很小,车辆在这段实际道路区域内行驶时航向角ψ同样可以认为是很小的,且实际上车辆的质心侧偏角β变化范围也很小,所以有:sin(ψ+β)≈ψ+β,cos(ψ+β)≈1,结合式(1)可以得到简化的车辆运动学模型,如式(2)所示:
图3为二自由度车辆动力学模型示意图,本方法是通过控制车辆的前轮转角来实现路径跟踪的目的,并且认为车辆保持匀速状态行驶,所以只需要考虑车辆的侧向运动,根据牛顿第二定律与力矩平衡关系,可得到如式(3)所示的二自由度车辆动力学模型:
式中vx为车辆质心处的纵向速度,单位m/s;Fyf为车辆前轮侧向力,单位N;Fyr为车辆后轮侧向力,单位N;m为车辆的质量,单位kg;Iz为车辆绕z轴的转动惯量,单位kg·m2;a为车辆质心o到车辆前轴的距离,单位m;b为车辆质心o到车辆后轴的距离,单位m;δf为车辆前轮转角,单位rad;
车辆实际的前轮转角δf通常也很小,可以近似认为:cosδf≈1,sinδf≈0,因此对式(3)进行简化,简化后的二自由度车辆动力学模型如式(4)所示:
车辆侧向轮胎力未达到饱和时,车辆侧向轮胎力Fy与轮胎侧偏角α可近似看作呈线性关系如式(5)所示:
式中Cf为车辆前轮的轮胎侧偏刚度,单位N·rad;Cr为车辆后轮的轮胎侧偏刚度,单位N·rad;αf为车辆前轮的轮胎侧偏角,单位rad;αr为车辆后轮的轮胎侧偏角,单位rad;
在车辆坐标系下,根据图3所示的几何关系,前轮的轮胎侧偏角αf和后轮的轮胎侧偏角αr有如式(6)的关系:
结合式(4)、式(5)和式(6),整理可得二自由度车辆动力学模型如式(7)所示:
步骤二、建立车辆自动驾驶控制器:
根据车辆运动的特点,建立能够使车辆按照一定轨迹行驶的车辆自动驾驶控制器,其运动示意图如图4,车辆的运动服从阿克曼几何关系,车辆轨迹曲率与前轮转角成正比:
或
其中,δa为车辆自动驾驶控制器决策出的当前时刻前轮转角,单位rad;L为轴距,单位m;vax为大地坐标系下车辆纵向速度,单位m/s;R为车辆转弯半径,单位m;aay为车辆大地坐标系下的横向加速度,单位m/s2;
假设车辆始终沿着道路中心线行驶,道路中心线的方程为f(t),道路中心线f(t)在X方向的坐标是函数x(t),道路中心线f(t)在Y方向的坐标是函数y(t);设在瞬时to车辆在Y方向的坐标为yao、车辆在Y方向的加速度为aayo、在Y方向的速度为vayo以及车辆的合速度为vao,当前位置在X方向坐标为x(to);假设车辆自动驾驶控制器感知到车辆前方道路上的某一点,该点定义为预视点,车辆质心o与该预视点在X方向的距离定义为预视距离d,对应于预视距离d有预视时间T,预视时间T表示的是车辆从当前位置行驶到该预视点所需要的时间,则预视时间车辆自动驾驶控制器感知到的预视点在X方向坐标为x(to+T),车辆自动驾驶控制器此时选择一个前轮转角使车辆能够使在经过时间T后到达预视点,该前轮转角对应的车辆的轨迹曲率为这样经过时间T之后,在时刻to+T车辆的横向位移ya为:
根据最小误差原则,车辆自动驾驶控制器总是希望选择一个车辆的最优的轨迹曲率记为使得车辆在T时间内走过距离d到达x(to+T)后,其预视点在Y方向的坐标ya与x(to+T)处的中心线轨道在Y方向的坐标y(to+T)相一致,由式(9)以及运动学原理求得车辆在Y方向的最优加速度为和车辆的最优的轨迹曲率为:
将车辆最优的轨迹曲率带入式(8)则可得到车辆自动驾驶控制器决策出的当前时刻前轮转角δa为:
步骤三、建立人车共驾***模型:
***的控制方案如图5所示,驾驶员与车辆自动驾驶控制器共同驾驶车辆为人车共驾***,步骤三通过建立人车共驾***模型对人车共驾***进行描述,由步骤二建立的车辆自动驾驶控制器决策出的当前时刻前轮转角δa,驾驶员决策出的当前时刻前轮转角δh,通过求解出当前时刻的驾驶权重ε后再按照式(12)给出的比例关系进行分配:
δf=εδh+(1-ε)δa (12)
式中δa为车辆自动驾驶控制器决策出的当前时刻前轮转角,单位rad;δh为驾驶员决策出的当前时刻前轮转角,单位rad;
求解出当前时刻的驾驶权重ε后,车辆自动驾驶控制器决策出的当前时刻前轮转角δa和驾驶员决策出的当前时刻前轮转角δh再根据式(12)给出的比例关系进行分配得到当前时刻最终的前轮转角δf作为当前时刻最终的前轮转角控制量;
结合式(2)、式(7)、式(11)和式(12),由于侧向车速相对于纵向车速较小可以近似看作v≈vx,整理可得人车共驾***模型如式(13):
该人车共驾***模型选取车辆质心o的侧向位移yo作为人车共驾***模型的输出,同时选取驾驶权重ε作为人车共驾***模型的控制输入,选取状态向量x=[yo ψ β r]T,人车共驾***模型可被描述成如式(14)所示的状态空间形式:
其中A为***矩阵,表示***内部状态变量的关系;B为控制矩阵,表示输入变量如何控制状态变量;C为输出矩阵,表示输出变量如何反映状态;E为常数项矩阵;各个矩阵表达式如下:
C=[1 0 0 0];
步骤四、采用模型预测方法进行人车共驾***控制器设计:
以步骤三中的人车共驾***模型作为人车共驾***控制器设计的预测模型,驾驶权重ε作为人车共驾***控制器的控制输入,设k为当前时刻,认为车辆在预测时域内速度保持不变,且认为驾驶员决策出的当前时刻前轮转角δh在预测时域内同样保持不变,将式(14)的人车共驾***模型进行离散化得到式(15):
式中Cc=C,Ec=E,Ts为采样时间,单位s;
人车共驾***控制器采用的模型预测方法中预测时域为P,控制时域为N,且满足N≤P,控制时域之外的人车共驾***控制器的控制输入保持不变,通过式(15)可以推导出人车共驾***控制器状态预测方程如式(16):
推导出人车共驾***控制器输出预测方程如式(17):
同时定义预测时域P内每一时刻人车共驾***控制器控制输入ε的序列Uε(k)、预测时域P内驾驶员决策出的每一时刻前轮转角δh的序列R(k)、预测时域P内车辆自动驾驶控制器决策出的每一时刻前轮转角δa的序列Ua(k)、预测时域P内每一时刻控制输出yo的序列Uy(k)、预测时域P内每一时刻道路中心线横向坐标y的序列Ry(k)和预测时域P内车辆自动驾驶控制器决策出的每一时刻前轮转角和驾驶员决策出的每一时刻前轮转角按照比例分配得到的预测时域P内每一时刻最终的前轮转角δf的序列U(k),如式(18):
式中δh(k+i)为k+i时刻的驾驶员决策出的前轮转角,单位rad;δf(k+i)为预测时域内k+i时刻车辆自动驾驶控制器决策出的前轮转角和预测时域内驾驶员决策出的前轮转角按照式(12)分配得到的最终的前轮转角,即为人车共驾***控制器实际控制车辆的前轮转角,单位rad;x(k+i)为k+i时刻的人车共驾***控制器的状态向量;yo(k+i)为k+i时刻的人车共驾***控制器的输出,即车辆质心的侧向位置,单位m;y(k+i),i=1,…,P为期望道路区域中心线f(t)在Y方向坐标离散量,离散间隔为vax·Ts,单位m;式中,i=1,2,3…P;
人车共驾***控制器的控制目标是一方面让驾驶员感受到车辆按照自己的驾驶意图行驶,通过跟踪驾驶员决策出的前轮转角实现,如式(19):
J1=‖(U(k)-R(k))‖2 (19)
另一方面使车辆发生危险的概率最小,通过跟踪道路中心线实现,如式(20):
J2=‖(Uy(k)-Ry(k))‖2 (20)
同时为了保证车辆转向的平顺性,应该使人车共驾***控制器的控制量即车辆前轮转角尽可能的小,如式(21):
J3=‖(U(k)‖2 (21)
引入权重矩阵Γh、Γy和Γu对J1、J2和J3三个优化目标的权重进行调整,人车共驾***控制器的优化目标如式(22):
本方法中道路边界可以通过车辆的感知***实时获得,且车辆必须在道路边界内行驶,即车辆坐标不超出道路边界,通过对车辆侧向位置约束简化考虑,道路加上车辆一半的宽度可以得到车辆前轴质心的道路边界约束和车辆后轴质心的道路边界约束,式中lf(ψ+β)表示车辆当前质心侧偏角与横摆角所造成的前轴端点的侧向位移量,lr(ψ+β)表示车辆当前质心侧偏角与横摆角所造成的后轴端点的侧向位移量,车辆侧向位置约束满足如下式(23)的不等式关系:
式中fl(x)为通过车辆的感知***实时获得的前方可行道路区域的左边界;fr(x)为通过车辆的感知***实时获得的前方可行道路区域的右边界;w为车辆宽度,单位m;lf为车辆质心o到车辆前端点的距离,单位m;lr为车辆质心o到车辆后端点的距离,单位m;
人车共驾***控制器必须满足***约束如式(24):
式中Cψ=[0 1 0 0],Cβ=[0 0 1 0];fl(k+i)为预测时域内前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位m;fr(k+i)则为预测时域内前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位m;
步骤五、进行驾驶权分配并计算控制量完成控制:
根据步骤四中优化求解出的预测时域P内每一时刻控制输入ε的序列Uε(k)、预测时域内车辆自动驾驶控制器的决策出的每一时刻前轮转角δa的序列Ua(k)和预测时域内驾驶员决策出的每一时刻前轮转角δh的序列R(k),取Uε(k)中的第一个量作为驾驶权重,取预测时域内车辆自动驾驶控制器决策出的每一时刻前轮转角δa的序列Ua(k)中的第一个量作为车辆自动驾驶控制器决策出的当前时刻前轮转角,取预测时域内驾驶员决策出的每一时刻前轮转角δh的序列R(k)中的第一个量作为驾驶员决策出的当前时刻前轮转角,根据式(12)求得当前时刻最终的前轮转角如式(25):
δf=Uε(1)·R(1)+(1-Uε(1))·Ua(1) (25)
当前时刻最终的前轮转角δf作为最终控制量传给车辆,车辆通过相应的执行机构执行控制量δf,实现驾驶员与车辆自动驾驶控制器协同控制车辆转向的过程。
Claims (1)
1.一种考虑驾驶权实时分配的人车协同转向控制方法,基于一种驾驶员和车辆自动驾驶控制器共同配合完成车辆转向控制的驾驶模式,该种模式下当驾驶员的驾驶行为不出现错误时,车辆自动驾驶控制器能够按照一定的比例帮助驾驶员分担一部分转向任务,减轻驾驶员负担,在驾驶员驾驶行为出现错误时,将驾驶员的驾驶权重减小甚至减少至零,由车辆自动驾驶控制器独立控制转向,其特征在于,本方法具体步骤如下:
步骤一、建立车辆动力学模型与车辆运动学模型:
建立大地坐标系:原点O固结于地面,X轴通常与车辆初始运动方向重合,X沿逆时针方向旋转90度为Y轴的正方向;
建立车辆坐标系:以车辆动力学模型中车辆质心o为坐标原点,沿着车辆前进的方向为x轴的正方向,x轴沿逆时针方向旋转90度为y轴的正方向建立坐标系;
用车辆运动学模型表征车辆的操纵稳定性与车辆的侧向运动的关系,并用二自由度车辆动力学模型表征车辆的操纵稳定性和车辆的横摆运动之间的关系,具体过程如下:
假定车辆是一个刚性体,车辆装置着四个不会发生形变的车轮,并以车辆前轮作为转向轮,根据车辆运动学方程以及车辆运动的几何关系得到车辆的运动学模型如式(1)所示:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>o</mi>
</msub>
<mo>=</mo>
<mi>v</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>o</mi>
</msub>
<mo>=</mo>
<mi>v</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&psi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>r</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
式中xo为车辆质心o的纵向位移,单位m;yo为车辆质心o的侧向位移,单位m;v为车辆质心的速度,单位m/s;r为车辆的横摆角速度,单位rad/s;ψ为车辆的航向角,单位rad;β为车辆的质心侧偏角,单位rad;
考虑到实际道路的曲率通常很小,车辆在这段实际道路区域内行驶时航向角ψ同样可以认为是很小的,且实际上车辆的质心侧偏角β变化范围也很小,所以有:sin(ψ+β)≈ψ+β,cos(ψ+β)≈1,结合式(1)可以得到简化的车辆运动学模型,如式(2)所示:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>o</mi>
</msub>
<mo>=</mo>
<mi>v</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>o</mi>
</msub>
<mo>=</mo>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&psi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>r</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
本方法是通过控制车辆的前轮转角来实现路径跟踪的目的,并且认为车辆保持匀速状态行驶,所以只需要考虑车辆的侧向运动,根据牛顿第二定律与力矩平衡关系,可得到如式(3)所示的二自由度车辆动力学模型:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>mv</mi>
<mi>x</mi>
</msub>
<mrow>
<mo>(</mo>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>r</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>x</mi>
<mi>f</mi>
</mrow>
</msub>
<msub>
<mi>sin&delta;</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>f</mi>
</mrow>
</msub>
<msub>
<mi>cos&delta;</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>r</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>a</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>x</mi>
<mi>f</mi>
</mrow>
</msub>
<msub>
<mi>sin&delta;</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>f</mi>
</mrow>
</msub>
<msub>
<mi>cos&delta;</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>bF</mi>
<mrow>
<mi>y</mi>
<mi>r</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式中vx为车辆质心处的纵向速度,单位m/s;Fyf为车辆前轮侧向力,单位N;Fyr为车辆后轮侧向力,单位N;m为车辆的质量,单位kg;Iz为车辆绕z轴的转动惯量,单位kg·m2;a为车辆质心o到车辆前轴的距离,单位m;b为车辆质心o到车辆后轴的距离,单位m;δf为车辆前轮转角,单位rad;
车辆实际的前轮转角δf通常也很小,可以近似认为:cosδf≈1,sinδf≈0,因此对式(3)进行简化,简化后的二自由度车辆动力学模型如式(4)所示:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>mv</mi>
<mi>x</mi>
</msub>
<mrow>
<mo>(</mo>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>r</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>f</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>r</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>aF</mi>
<mrow>
<mi>y</mi>
<mi>f</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>bF</mi>
<mrow>
<mi>y</mi>
<mi>r</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
车辆侧向轮胎力未达到饱和时,车辆侧向轮胎力Fy与轮胎侧偏角α可近似看作呈线性关系如式(5)所示:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>f</mi>
</mrow>
</msub>
<mo>=</mo>
<mn>2</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<msub>
<mi>&alpha;</mi>
<mi>f</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>y</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<mn>2</mn>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<msub>
<mi>&alpha;</mi>
<mi>r</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
式中Cf为车辆前轮的轮胎侧偏刚度,单位N·rad;Cr为车辆后轮的轮胎侧偏刚度,单位N·rad;αf为车辆前轮的轮胎侧偏角,单位rad;αr为车辆后轮的轮胎侧偏角,单位rad;
在车辆坐标系下,前轮的轮胎侧偏角αf和后轮的轮胎侧偏角αr有如式(6)的关系:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>f</mi>
</msub>
<mo>=</mo>
<mi>&beta;</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mi>a</mi>
<mi>r</mi>
</mrow>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
</mfrac>
<mo>-</mo>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>r</mi>
</msub>
<mo>=</mo>
<mi>&beta;</mi>
<mo>-</mo>
<mfrac>
<mrow>
<mi>b</mi>
<mi>r</mi>
</mrow>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
结合式(4)、式(5)和式(6),整理可得二自由度车辆动力学模型如式(7)所示:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>mv</mi>
<mi>x</mi>
</msub>
</mrow>
</mfrac>
<mi>&beta;</mi>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mo>-</mo>
<msub>
<mi>bC</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mi>mv</mi>
<mi>x</mi>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mi>r</mi>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>mv</mi>
<mi>x</mi>
</msub>
</mrow>
</mfrac>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mo>-</mo>
<msub>
<mi>bC</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
</mfrac>
<mi>&beta;</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msup>
<mi>a</mi>
<mn>2</mn>
</msup>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msup>
<mi>b</mi>
<mn>2</mn>
</msup>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
</mrow>
</mfrac>
<mi>r</mi>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
</mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
</mfrac>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤二、建立车辆自动驾驶控制器:
根据车辆运动的特点,建立能够使车辆按照一定轨迹行驶的车辆自动驾驶控制器,车辆的运动服从阿克曼几何关系,车辆轨迹曲率与前轮转角成正比:
或
其中,δa为车辆自动驾驶控制器决策出的当前时刻前轮转角,单位rad;L为轴距,单位m;vax为大地坐标系下车辆纵向速度,单位m/s;R为车辆转弯半径,单位m;aay为车辆大地坐标系下的横向加速度,单位m/s2;
假设车辆始终沿着道路中心线行驶,道路中心线的方程为f(t),道路中心线f(t)在X方向的坐标是函数x(t),道路中心线f(t)在Y方向的坐标是函数y(t);设在瞬时to车辆在Y方向的坐标为yao、车辆在Y方向的加速度为aayo、在Y方向的速度为vayo以及车辆的合速度为vao,当前位置在X方向坐标为x(to);假设车辆自动驾驶控制器感知到车辆前方道路上的某一点,该点定义为预视点,车辆质心o与该预视点在X方向的距离定义为预视距离d,对应于预视距离d有预视时间T,预视时间T表示的是车辆从当前位置行驶到该预视点所需要的时间,则预视时间车辆自动驾驶控制器感知到的预视点在X方向坐标为x(to+T),车辆自动驾驶控制器此时选择一个前轮转角使车辆能够使在经过时间T后到达预视点,该前轮转角对应的车辆的轨迹曲率为这样经过时间T之后,在时刻to+T车辆的横向位移ya为:
<mrow>
<msub>
<mi>y</mi>
<mi>a</mi>
</msub>
<mo>=</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>a</mi>
<mi>o</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>Tv</mi>
<mrow>
<mi>a</mi>
<mi>y</mi>
<mi>o</mi>
</mrow>
</msub>
<mo>+</mo>
<mfrac>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
<mn>2</mn>
</mfrac>
<msub>
<mi>a</mi>
<mrow>
<mi>a</mi>
<mi>y</mi>
<mi>o</mi>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
根据最小误差原则,车辆自动驾驶控制器总是希望选择一个车辆的最优的轨迹曲率记为使得车辆在T时间内走过距离d到达x(to+T)后,其预视点在Y方向的坐标ya与x(to+T)处的中心线轨道在Y方向的坐标y(to+T)相一致,由式(9)以及运动学原理求得车辆在Y方向的最优加速度为和车辆的最优的轨迹曲率为:
<mrow>
<mfrac>
<mn>1</mn>
<msup>
<mi>R</mi>
<mo>*</mo>
</msup>
</mfrac>
<mo>=</mo>
<mfrac>
<mn>2</mn>
<mi>d</mi>
</mfrac>
<mo>&lsqb;</mo>
<mi>y</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>o</mi>
</msub>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>a</mi>
<mi>y</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>Tv</mi>
<mrow>
<mi>a</mi>
<mi>y</mi>
</mrow>
</msub>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
将车辆最优的轨迹曲率带入式(8)则可得到车辆自动驾驶控制器决策出的当前时刻前轮转角δa为:
<mrow>
<msub>
<mi>&delta;</mi>
<mi>a</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>L</mi>
</mrow>
<mi>d</mi>
</mfrac>
<mo>&lsqb;</mo>
<mi>y</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>o</mi>
</msub>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>a</mi>
<mi>y</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>Tv</mi>
<mrow>
<mi>a</mi>
<mi>y</mi>
</mrow>
</msub>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤三、建立人车共驾***模型:
驾驶员与车辆自动驾驶控制器共同驾驶车辆为人车共驾***,步骤三通过建立人车共驾***模型对人车共驾***进行描述,由步骤二建立的车辆自动驾驶控制器决策出的当前时刻前轮转角δa,驾驶员决策出的当前时刻前轮转角δh,通过求解出当前时刻的驾驶权重ε后再按照式(12)给出的比例关系进行分配:
δf=εδh+(1-ε)δa (12)
式中δa为车辆自动驾驶控制器决策出的当前时刻前轮转角,单位rad;δh为驾驶员决策出的当前时刻前轮转角,单位rad;
求解出当前时刻的驾驶权重ε后,车辆自动驾驶控制器决策出的当前时刻前轮转角δa和驾驶员决策出的当前时刻前轮转角δh再根据式(12)给出的比例关系进行分配得到当前时刻最终的前轮转角δf作为当前时刻最终的前轮转角控制量;
结合式(2)、式(7)、式(11)和式(12),由于侧向车速相对于纵向车速较小可以近似看作v≈vx,整理可得人车共驾***模型如式(13):
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>o</mi>
</msub>
<mo>=</mo>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&psi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>r</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&beta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
</mrow>
<mrow>
<msup>
<mi>mvd</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mo>+</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
</mrow>
<mrow>
<msup>
<mi>md</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mi>&psi;</mi>
<mo>+</mo>
<mrow>
<mo>&lsqb;</mo>
<mrow>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mo>-</mo>
<msub>
<mi>bC</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>mv</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>r</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
<mi>v</mi>
</mrow>
<mrow>
<msup>
<mi>mvd</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mi>v</mi>
</mrow>
</mfrac>
<mo>{</mo>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>L</mi>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>&lsqb;</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>y</mi>
<mo>-</mo>
<mi>T</mi>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>}</mo>
<mi>&epsiv;</mi>
<mo>-</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>mvd</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>r</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mi>y</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
<mi>v</mi>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mi>&psi;</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msup>
<mi>a</mi>
<mn>2</mn>
</msup>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msup>
<mi>b</mi>
<mn>2</mn>
</msup>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<mi>v</mi>
</mrow>
</mfrac>
<mi>r</mi>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>bC</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
<mi>v</mi>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mi>&beta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
</mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
</mfrac>
<mo>{</mo>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>L</mi>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>&lsqb;</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>y</mi>
<mo>-</mo>
<mi>T</mi>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>}</mo>
<mi>&epsiv;</mi>
<mo>-</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
该人车共驾***模型选取车辆质心o的侧向位移yo作为人车共驾***模型的输出,同时选取驾驶权重ε作为人车共驾***模型的控制输入,选取状态向量x=[yo ψ β r]T,人车共驾***模型可被描述成如式(14)所示的状态空间形式:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>A</mi>
<mi>x</mi>
<mo>+</mo>
<mi>B</mi>
<mi>&epsiv;</mi>
<mo>+</mo>
<mi>E</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mo>=</mo>
<mi>C</mi>
<mi>x</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
其中A为***矩阵,表示***内部状态变量的关系;B为控制矩阵,表示输入变量如何控制状态变量;C为输出矩阵,表示输出变量如何反映状态;E为常数项矩阵;各个矩阵表达式如下:
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>v</mi>
</mtd>
<mtd>
<mi>v</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
</mrow>
<mrow>
<msup>
<mi>mvd</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
</mrow>
<mrow>
<msup>
<mi>md</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
<mi>v</mi>
</mrow>
<mrow>
<msup>
<mi>mvd</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mtd>
<mtd>
<mrow>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mo>-</mo>
<msub>
<mi>bC</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>mv</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
<mi>v</mi>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>bC</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>T</mi>
<mi>v</mi>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msup>
<mi>a</mi>
<mn>2</mn>
</msup>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msup>
<mi>b</mi>
<mn>2</mn>
</msup>
<msub>
<mi>C</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<mi>v</mi>
</mrow>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<mi>B</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mi>v</mi>
</mrow>
</mfrac>
<mo>{</mo>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>L</mi>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>&lsqb;</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>y</mi>
<mo>-</mo>
<mi>T</mi>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
</mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
</mfrac>
<mo>{</mo>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>L</mi>
</mrow>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>&lsqb;</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>y</mi>
<mo>-</mo>
<mi>T</mi>
<mi>v</mi>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<mi>E</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>C</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>mvd</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>aC</mi>
<mi>f</mi>
</msub>
<mi>L</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>+</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
C=[1 0 0 0];
步骤四、采用模型预测方法进行人车共驾***控制器设计:
以步骤三中的人车共驾***模型作为人车共驾***控制器设计的预测模型,驾驶权重ε作为人车共驾***控制器的控制输入,设k为当前时刻,认为车辆在预测时域内速度保持不变,且认为驾驶员决策出的当前时刻前轮转角δh在预测时域内同样保持不变,将式(14)的人车共驾***模型进行离散化得到式(15):
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
式中Ts为采样时间,单位s;
人车共驾***控制器采用的模型预测方法中预测时域为P,控制时域为N,且满足N≤P,控制时域之外的人车共驾***控制器的控制输入保持不变,通过式(15)可以推导出人车共驾***控制器状态预测方程如式(16):
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mn>2</mn>
</msubsup>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>N</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mi>N</mi>
</msubsup>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mi>P</mi>
</msubsup>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>P</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>P</mi>
<mo>-</mo>
<mi>N</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</munderover>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>P</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<mn>...</mn>
<mo>+</mo>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
推导出人车共驾***控制器输出预测方程如式(17):
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>N</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mi>N</mi>
</msubsup>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mo>...</mo>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<mo>...</mo>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mi>P</mi>
</msubsup>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>P</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mo>...</mo>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>P</mi>
<mo>-</mo>
<mi>N</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>N</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msubsup>
<mi>A</mi>
<mi>c</mi>
<mrow>
<mi>P</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<mo>...</mo>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>c</mi>
</msub>
<msub>
<mi>E</mi>
<mi>c</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
同时定义预测时域P内每一时刻人车共驾***控制器控制输入ε的序列Uε(k)、预测时域P内驾驶员决策出的每一时刻前轮转角δh的序列R(k)、预测时域P内车辆自动驾驶控制器决策出的每一时刻前轮转角δa的序列Ua(k)、预测时域P内每一时刻控制输出yo的序列Uy(k)、预测时域P内每一时刻道路中心线横向坐标y的序列Ry(k)和预测时域P内车辆自动驾驶控制器决策出的每一时刻前轮转角和驾驶员决策出的每一时刻前轮转角按照比例分配得到的预测时域P内每一时刻最终的前轮转角δf的序列U(k),如式(18):
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>U</mi>
<mi>&epsiv;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>R</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>U</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>U</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>a</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<msub>
<mi>R</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>U</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>.</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>P</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
式中δh(k+i)为k+i时刻的驾驶员决策出的前轮转角,单位rad;δf(k+i)为预测时域内k+i时刻车辆自动驾驶控制器决策出的前轮转角和预测时域内驾驶员决策出的前轮转角按照式(12)分配得到的最终的前轮转角,即为人车共驾***控制器实际控制车辆的前轮转角,单位rad;x(k+i)为k+i时刻的人车共驾***控制器的状态向量;yo(k+i)为k+i时刻的人车共驾***控制器的输出,即车辆质心的侧向位置,单位m;y(k+i),i=1,…,P为期望道路区域中心线f(t)在Y方向坐标离散量,离散间隔为vax·Ts,单位m;式中,i=1,2,3…P;
人车共驾***控制器的控制目标是一方面让驾驶员感受到车辆按照自己的驾驶意图行驶,通过跟踪驾驶员决策出的前轮转角实现,如式(19):
J1=‖(U(k)-R(k))‖2 (19)
另一方面使车辆发生危险的概率最小,通过跟踪道路中心线实现,如式(20):
J2=‖(Uy(k)-Ry(k))‖2 (20)
同时为了保证车辆转向的平顺性,应该使人车共驾***控制器的控制量即车辆前轮转角尽可能的小,如式(21):
J3=‖(U(k)‖2 (21)
引入权重矩阵Γh、Γy和Γu对J1、J2和J3三个优化目标的权重进行调整,人车共驾***控制器的优化目标如式(22):
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<munder>
<mi>min</mi>
<mrow>
<mi>&epsiv;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
</mrow>
</munder>
<mi>J</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>J</mi>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>&Gamma;</mi>
<mi>h</mi>
</msub>
<mo>(</mo>
<mi>U</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<mi>R</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
<mo>+</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>&Gamma;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>U</mi>
<mi>y</mi>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<msub>
<mi>R</mi>
<mi>y</mi>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
<mo>+</mo>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>&Gamma;</mi>
<mi>u</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>U</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
本方法中道路边界可以通过车辆的感知***实时获得,且车辆必须在道路边界内行驶,即车辆坐标不超出道路边界,通过对车辆侧向位置约束简化考虑,道路加上车辆一半的宽度可以得到车辆前轴质心的道路边界约束和车辆后轴质心的道路边界约束,式中lf(ψ+β)表示车辆当前质心侧偏角与横摆角所造成的前轴端点的侧向位移量,lr(ψ+β)表示车辆当前质心侧偏角与横摆角所造成的后轴端点的侧向位移量,车辆侧向位置约束满足如下式(23)的不等式关系:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>f</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
<mo>&le;</mo>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mo>&le;</mo>
<msub>
<mi>f</mi>
<mi>l</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>f</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
<mo>&le;</mo>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mo>&le;</mo>
<msub>
<mi>f</mi>
<mi>l</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&psi;</mi>
<mo>+</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>23</mn>
<mo>)</mo>
</mrow>
</mrow>
式中fl(x)为通过车辆的感知***实时获得的前方可行道路区域的左边界;fr(x)为通过车辆的感知***实时获得的前方可行道路区域的右边界;w为车辆宽度,单位m;lf为车辆质心o到车辆前端点的距离,单位m;lr为车辆质心o到车辆后端点的距离,单位m;
人车共驾***控制器必须满足***约束如式(24):
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>A</mi>
<mi>c</mi>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>c</mi>
</msub>
<msub>
<mi>&delta;</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>f</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>&psi;</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>&beta;</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
<mo>&le;</mo>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mi>f</mi>
<mi>l</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>&psi;</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>&beta;</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>f</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>&psi;</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>&beta;</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
<mo>&le;</mo>
<msub>
<mi>y</mi>
<mi>o</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mi>f</mi>
<mi>l</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>f</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>&psi;</mi>
</msub>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>&beta;</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mi>i</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>w</mi>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>24</mn>
<mo>)</mo>
</mrow>
</mrow>
式中Cψ=[0 1 0 0],Cβ=[0 0 1 0];fl(k+i)为预测时域内前方可行道路区域左边界线fl(x)在时刻k+i的采样值,单位m;fr(k+i)则为预测时域内前方可行道路区域右边界线fr(x)在时刻k+i的采样值,单位m;
步骤五、进行驾驶权分配并计算控制量完成控制:
根据步骤四中优化求解出的预测时域P内每一时刻控制输入ε的序列Uε(k)、预测时域内车辆自动驾驶控制器的决策出的每一时刻前轮转角δa的序列Ua(k)和预测时域内驾驶员决策出的每一时刻前轮转角δh的序列R(k),取Uε(k)中的第一个量作为驾驶权重,取预测时域内车辆自动驾驶控制器决策出的每一时刻前轮转角δa的序列Ua(k)中的第一个量作为车辆自动驾驶控制器决策出的当前时刻前轮转角,取预测时域内驾驶员决策出的每一时刻前轮转角δh的序列R(k)中的第一个量作为驾驶员决策出的当前时刻前轮转角,根据式(12)求得当前时刻最终的前轮转角如式(25):
δf=Uε(1)·R(1)+(1-Uε(1))·Ua(1) (25)
当前时刻最终的前轮转角δf作为最终控制量传给车辆,车辆通过相应的执行机构执行控制量δf,实现驾驶员与车辆自动驾驶控制器协同控制车辆转向的过程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711082359.8A CN107804315B (zh) | 2017-11-07 | 2017-11-07 | 一种考虑驾驶权实时分配的人车协同转向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711082359.8A CN107804315B (zh) | 2017-11-07 | 2017-11-07 | 一种考虑驾驶权实时分配的人车协同转向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107804315A true CN107804315A (zh) | 2018-03-16 |
CN107804315B CN107804315B (zh) | 2019-07-16 |
Family
ID=61591691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711082359.8A Active CN107804315B (zh) | 2017-11-07 | 2017-11-07 | 一种考虑驾驶权实时分配的人车协同转向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107804315B (zh) |
Cited By (33)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108454628A (zh) * | 2018-04-17 | 2018-08-28 | 吉林大学 | 一种驾驶员在环的人车协同转向滚动优化控制方法 |
CN108469806A (zh) * | 2018-03-26 | 2018-08-31 | 重庆邮电大学 | 交替式人机共驾中驾驶权转移方法 |
CN108549367A (zh) * | 2018-04-09 | 2018-09-18 | 吉林大学 | 一种基于预测安全的人机切换控制方法 |
CN108569336A (zh) * | 2018-04-26 | 2018-09-25 | 武汉理工大学 | 在动力学约束下基于车辆运动学模型转向控制方法 |
CN108725453A (zh) * | 2018-06-11 | 2018-11-02 | 南京航空航天大学 | 基于驾驶员模型和操纵逆动力学的人机共驾控制***及其切换模式 |
CN108819951A (zh) * | 2018-07-27 | 2018-11-16 | 重庆大学 | 一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法 |
CN109318905A (zh) * | 2018-08-22 | 2019-02-12 | 江苏大学 | 一种智能汽车路径跟踪混合控制方法 |
CN109435961A (zh) * | 2018-11-13 | 2019-03-08 | 常熟理工学院 | 一种基于驾驶人特性的全线控电动汽车底盘协调控制方法 |
CN109795486A (zh) * | 2019-03-01 | 2019-05-24 | 大连理工大学 | 在人机共驾车道保持***中驾驶权分配的方法 |
CN109885040A (zh) * | 2019-02-20 | 2019-06-14 | 江苏大学 | 一种人机共驾中的车辆驾驶控制权分配*** |
CN109991856A (zh) * | 2019-04-25 | 2019-07-09 | 南京理工大学 | 一种机器人驾驶车辆集成协调控制方法 |
CN110096748A (zh) * | 2019-04-01 | 2019-08-06 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
CN110406592A (zh) * | 2019-06-25 | 2019-11-05 | 湖北汽车工业学院 | 一种人车驾驶权分配的自动驾驶车辆转向***及控制方法 |
CN110481563A (zh) * | 2019-09-02 | 2019-11-22 | 上海智驾汽车科技有限公司 | 基于驾驶员神经肌肉模型的人机共驾共享控制算法 |
CN110509930A (zh) * | 2019-08-16 | 2019-11-29 | 上海智驾汽车科技有限公司 | 人机共驾控制方法以及装置、电子设备、存储介质 |
CN110834628A (zh) * | 2018-08-15 | 2020-02-25 | 重庆好德译信息技术有限公司 | 一种适用于汽车的躲避障碍物控制方法和*** |
CN110962844A (zh) * | 2019-10-28 | 2020-04-07 | 纵目科技(上海)股份有限公司 | 一种车辆航向角修正方法及***、存储介质及终端 |
CN111532283A (zh) * | 2020-05-15 | 2020-08-14 | 吉林大学 | 一种基于模型预测控制的半挂汽车列车的路径跟踪方法 |
CN111688704A (zh) * | 2020-06-24 | 2020-09-22 | 吉林大学 | 一种基于驾驶状态预测的人机力矩协同转向控制方法 |
CN111717207A (zh) * | 2020-07-09 | 2020-09-29 | 吉林大学 | 一种考虑人车冲突的协同转向控制方法 |
CN111880530A (zh) * | 2020-07-02 | 2020-11-03 | 坤泰车辆***(常州)有限公司 | 车辆低速行驶时的路径记录方法 |
CN111930112A (zh) * | 2020-06-30 | 2020-11-13 | 广西科技大学 | 一种基于mpc的智能车辆路径跟踪控制方法及*** |
WO2020238011A1 (zh) * | 2019-05-28 | 2020-12-03 | 南京天辰礼达电子科技有限公司 | 一种履带式拖拉机运动学估计及偏差校准方法 |
CN112078570A (zh) * | 2020-08-04 | 2020-12-15 | 武汉乐庭软件技术有限公司 | 一种基于阿克曼转向模型的汽车定位方法 |
CN113076641A (zh) * | 2021-03-31 | 2021-07-06 | 同济大学 | 基于风险评估的智能车人机协同转向控制并行计算方法 |
CN113101079A (zh) * | 2021-05-20 | 2021-07-13 | 南京邮电大学 | 基于多约束条件的智能轮椅、动态共享控制方法及*** |
CN113341960A (zh) * | 2021-05-26 | 2021-09-03 | 重庆大学 | 基于监督式dqn算法的自动驾驶汽车转向控制方法 |
CN113650609A (zh) * | 2021-09-28 | 2021-11-16 | 中国科学技术大学先进技术研究院 | 基于模糊规则的人机共驾控制权柔性转移方法及*** |
CN113978548A (zh) * | 2021-11-12 | 2022-01-28 | 京东鲲鹏(江苏)科技有限公司 | 应用于无人车的转向协同控制方法、装置、设备及介质 |
CN116495014A (zh) * | 2023-06-28 | 2023-07-28 | 北京理工大学 | 一种自进化非博弈自动驾驶车辆人机共驾方法及*** |
CN116729417A (zh) * | 2023-05-22 | 2023-09-12 | 南京航空航天大学 | 一种基于非合作博弈的人机共驾横纵向联合控制方法 |
CN117485325A (zh) * | 2024-01-02 | 2024-02-02 | 中国重汽集团济南动力有限公司 | 一种多轴分布式电驱车辆转向控制方法及车辆 |
CN117601857A (zh) * | 2023-12-18 | 2024-02-27 | 广东工业大学 | 一种基于轨迹预测的人机共驾切换控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1346856A2 (en) * | 2002-03-20 | 2003-09-24 | Ford Global Technologies, Inc. | A system and method for determining the roll angle of a vehicle |
CN103448716A (zh) * | 2013-09-12 | 2013-12-18 | 清华大学 | 分布式电驱动车辆纵-横-垂向力协同控制方法 |
CN106004870A (zh) * | 2016-06-23 | 2016-10-12 | 吉林大学 | 一种基于变权重模型预测算法的车辆稳定性集成控制方法 |
CN106882185A (zh) * | 2017-03-10 | 2017-06-23 | 南京林业大学 | 一种含驾驶员焦点预瞄模型的车辆自主转向控制方法 |
-
2017
- 2017-11-07 CN CN201711082359.8A patent/CN107804315B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1346856A2 (en) * | 2002-03-20 | 2003-09-24 | Ford Global Technologies, Inc. | A system and method for determining the roll angle of a vehicle |
CN103448716A (zh) * | 2013-09-12 | 2013-12-18 | 清华大学 | 分布式电驱动车辆纵-横-垂向力协同控制方法 |
CN106004870A (zh) * | 2016-06-23 | 2016-10-12 | 吉林大学 | 一种基于变权重模型预测算法的车辆稳定性集成控制方法 |
CN106882185A (zh) * | 2017-03-10 | 2017-06-23 | 南京林业大学 | 一种含驾驶员焦点预瞄模型的车辆自主转向控制方法 |
Cited By (52)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108469806A (zh) * | 2018-03-26 | 2018-08-31 | 重庆邮电大学 | 交替式人机共驾中驾驶权转移方法 |
CN108469806B (zh) * | 2018-03-26 | 2020-10-16 | 重庆邮电大学 | 交替式人机共驾中驾驶权转移方法 |
CN108549367A (zh) * | 2018-04-09 | 2018-09-18 | 吉林大学 | 一种基于预测安全的人机切换控制方法 |
CN108454628B (zh) * | 2018-04-17 | 2019-06-04 | 吉林大学 | 一种驾驶员在环的人车协同转向滚动优化控制方法 |
CN108454628A (zh) * | 2018-04-17 | 2018-08-28 | 吉林大学 | 一种驾驶员在环的人车协同转向滚动优化控制方法 |
CN108569336A (zh) * | 2018-04-26 | 2018-09-25 | 武汉理工大学 | 在动力学约束下基于车辆运动学模型转向控制方法 |
CN108725453A (zh) * | 2018-06-11 | 2018-11-02 | 南京航空航天大学 | 基于驾驶员模型和操纵逆动力学的人机共驾控制***及其切换模式 |
CN108819951B (zh) * | 2018-07-27 | 2020-11-17 | 重庆大学 | 一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法 |
CN108819951A (zh) * | 2018-07-27 | 2018-11-16 | 重庆大学 | 一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法 |
CN110834628A (zh) * | 2018-08-15 | 2020-02-25 | 重庆好德译信息技术有限公司 | 一种适用于汽车的躲避障碍物控制方法和*** |
CN110834628B (zh) * | 2018-08-15 | 2021-07-27 | 陈勇 | 一种适用于汽车的躲避障碍物控制方法和*** |
CN109318905A (zh) * | 2018-08-22 | 2019-02-12 | 江苏大学 | 一种智能汽车路径跟踪混合控制方法 |
CN109318905B (zh) * | 2018-08-22 | 2020-06-09 | 江苏大学 | 一种智能汽车路径跟踪混合控制方法 |
CN109435961A (zh) * | 2018-11-13 | 2019-03-08 | 常熟理工学院 | 一种基于驾驶人特性的全线控电动汽车底盘协调控制方法 |
CN109885040A (zh) * | 2019-02-20 | 2019-06-14 | 江苏大学 | 一种人机共驾中的车辆驾驶控制权分配*** |
CN109885040B (zh) * | 2019-02-20 | 2022-04-26 | 江苏大学 | 一种人机共驾中的车辆驾驶控制权分配*** |
CN109795486B (zh) * | 2019-03-01 | 2021-06-11 | 大连理工大学 | 在人机共驾车道保持***中驾驶权分配的方法 |
CN109795486A (zh) * | 2019-03-01 | 2019-05-24 | 大连理工大学 | 在人机共驾车道保持***中驾驶权分配的方法 |
CN110096748B (zh) * | 2019-04-01 | 2022-11-18 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
CN110096748A (zh) * | 2019-04-01 | 2019-08-06 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
CN109991856B (zh) * | 2019-04-25 | 2022-04-08 | 南京理工大学 | 一种机器人驾驶车辆集成协调控制方法 |
CN109991856A (zh) * | 2019-04-25 | 2019-07-09 | 南京理工大学 | 一种机器人驾驶车辆集成协调控制方法 |
WO2020238011A1 (zh) * | 2019-05-28 | 2020-12-03 | 南京天辰礼达电子科技有限公司 | 一种履带式拖拉机运动学估计及偏差校准方法 |
CN110406592A (zh) * | 2019-06-25 | 2019-11-05 | 湖北汽车工业学院 | 一种人车驾驶权分配的自动驾驶车辆转向***及控制方法 |
CN110509930A (zh) * | 2019-08-16 | 2019-11-29 | 上海智驾汽车科技有限公司 | 人机共驾控制方法以及装置、电子设备、存储介质 |
CN110481563B (zh) * | 2019-09-02 | 2020-08-11 | 上海智驾汽车科技有限公司 | 基于驾驶员神经肌肉模型的人机共驾共享控制算法 |
CN110481563A (zh) * | 2019-09-02 | 2019-11-22 | 上海智驾汽车科技有限公司 | 基于驾驶员神经肌肉模型的人机共驾共享控制算法 |
CN110962844A (zh) * | 2019-10-28 | 2020-04-07 | 纵目科技(上海)股份有限公司 | 一种车辆航向角修正方法及***、存储介质及终端 |
CN111532283B (zh) * | 2020-05-15 | 2022-03-25 | 吉林大学 | 一种基于模型预测控制的半挂汽车列车的路径跟踪方法 |
CN111532283A (zh) * | 2020-05-15 | 2020-08-14 | 吉林大学 | 一种基于模型预测控制的半挂汽车列车的路径跟踪方法 |
CN111688704A (zh) * | 2020-06-24 | 2020-09-22 | 吉林大学 | 一种基于驾驶状态预测的人机力矩协同转向控制方法 |
CN111688704B (zh) * | 2020-06-24 | 2021-05-25 | 吉林大学 | 一种基于驾驶状态预测的人机力矩协同控制方法 |
CN111930112A (zh) * | 2020-06-30 | 2020-11-13 | 广西科技大学 | 一种基于mpc的智能车辆路径跟踪控制方法及*** |
CN111880530A (zh) * | 2020-07-02 | 2020-11-03 | 坤泰车辆***(常州)有限公司 | 车辆低速行驶时的路径记录方法 |
CN111717207B (zh) * | 2020-07-09 | 2021-07-23 | 吉林大学 | 一种考虑人车冲突的协同转向控制方法 |
CN111717207A (zh) * | 2020-07-09 | 2020-09-29 | 吉林大学 | 一种考虑人车冲突的协同转向控制方法 |
CN112078570A (zh) * | 2020-08-04 | 2020-12-15 | 武汉乐庭软件技术有限公司 | 一种基于阿克曼转向模型的汽车定位方法 |
CN113076641A (zh) * | 2021-03-31 | 2021-07-06 | 同济大学 | 基于风险评估的智能车人机协同转向控制并行计算方法 |
CN113101079A (zh) * | 2021-05-20 | 2021-07-13 | 南京邮电大学 | 基于多约束条件的智能轮椅、动态共享控制方法及*** |
CN113341960A (zh) * | 2021-05-26 | 2021-09-03 | 重庆大学 | 基于监督式dqn算法的自动驾驶汽车转向控制方法 |
CN113341960B (zh) * | 2021-05-26 | 2022-06-03 | 重庆大学 | 基于监督式dqn算法的自动驾驶汽车转向控制方法 |
CN113650609A (zh) * | 2021-09-28 | 2021-11-16 | 中国科学技术大学先进技术研究院 | 基于模糊规则的人机共驾控制权柔性转移方法及*** |
CN113978548A (zh) * | 2021-11-12 | 2022-01-28 | 京东鲲鹏(江苏)科技有限公司 | 应用于无人车的转向协同控制方法、装置、设备及介质 |
CN113978548B (zh) * | 2021-11-12 | 2023-01-31 | 京东鲲鹏(江苏)科技有限公司 | 应用于无人车的转向协同控制方法、装置、设备及介质 |
CN116729417A (zh) * | 2023-05-22 | 2023-09-12 | 南京航空航天大学 | 一种基于非合作博弈的人机共驾横纵向联合控制方法 |
CN116729417B (zh) * | 2023-05-22 | 2024-03-15 | 南京航空航天大学 | 一种基于非合作博弈的人机共驾横纵向联合控制方法 |
CN116495014A (zh) * | 2023-06-28 | 2023-07-28 | 北京理工大学 | 一种自进化非博弈自动驾驶车辆人机共驾方法及*** |
CN116495014B (zh) * | 2023-06-28 | 2023-09-01 | 北京理工大学 | 一种自进化非博弈自动驾驶车辆人机共驾方法及*** |
CN117601857A (zh) * | 2023-12-18 | 2024-02-27 | 广东工业大学 | 一种基于轨迹预测的人机共驾切换控制方法 |
CN117601857B (zh) * | 2023-12-18 | 2024-05-10 | 广东工业大学 | 一种基于轨迹预测的人机共驾切换控制方法 |
CN117485325A (zh) * | 2024-01-02 | 2024-02-02 | 中国重汽集团济南动力有限公司 | 一种多轴分布式电驱车辆转向控制方法及车辆 |
CN117485325B (zh) * | 2024-01-02 | 2024-03-19 | 中国重汽集团济南动力有限公司 | 一种多轴分布式电驱车辆转向控制方法及车辆 |
Also Published As
Publication number | Publication date |
---|---|
CN107804315B (zh) | 2019-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107804315A (zh) | 一种考虑驾驶权实时分配的人车协同转向控制方法 | |
CN108454628B (zh) | 一种驾驶员在环的人车协同转向滚动优化控制方法 | |
CN111890951B (zh) | 智能电动汽车轨迹跟踪与运动控制方法 | |
CN108819951A (zh) | 一种考虑驾驶员驾驶技能的人机共驾横向驾驶权分配方法 | |
CN107856737B (zh) | 一种基于危险程度变权重的人机协同转向控制方法 | |
CN107943071B (zh) | 无人车的编队保持控制方法及*** | |
CN107521496B (zh) | 一种无人车辆的横纵向协调控制轨迹跟随控制方法 | |
CN106184199B (zh) | 分布式控制电动汽车稳定性的集成控制方法 | |
CN106671982B (zh) | 基于多智能体的无人驾驶电动汽车自动超车***及方法 | |
CN107380161B (zh) | 一种辅助驾驶员实现理想行驶轨迹的主动转向控制装置 | |
CN104977933B (zh) | 一种自主驾驶车辆的区域型路径跟踪控制方法 | |
CN111717207B (zh) | 一种考虑人车冲突的协同转向控制方法 | |
Cai et al. | Implementation and development of a trajectory tracking control system for intelligent vehicle | |
CN109017778A (zh) | 四轮独立驱动车辆的期望路径主动转向控制方法 | |
CN109976159A (zh) | 基于安全可控域的智能车辆横向控制方法 | |
CN108791491A (zh) | 一种基于自评价学习的车辆侧向跟踪控制方法 | |
CN106004870A (zh) | 一种基于变权重模型预测算法的车辆稳定性集成控制方法 | |
CN109144076A (zh) | 一种多车辆横纵向耦合协同控制***及控制方法 | |
CN108717268A (zh) | 基于最优控制与安全距离的自动驾驶最速操纵控制***及其控制方法 | |
CN108773376A (zh) | 一种融合驾驶意图的汽车多目标分层协同控制与优化方法 | |
CN107512262A (zh) | 一种针对执行驱动空间受限时的车辆稳定控制***轮胎力分配方法 | |
CN207328574U (zh) | 一种基于主动安全的智能汽车轨迹跟踪控制*** | |
CN109017760A (zh) | 车辆期望轨迹跟踪方法、装置及滚动时域优化算法 | |
CN113650609B (zh) | 基于模糊规则的人机共驾控制权柔性转移方法及*** | |
CN113553726B (zh) | 一种冰雪环境下的主从博弈型人机协同转向控制方法 |
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 |