CN107521496B - 一种无人车辆的横纵向协调控制轨迹跟随控制方法 - Google Patents
一种无人车辆的横纵向协调控制轨迹跟随控制方法 Download PDFInfo
- Publication number
- CN107521496B CN107521496B CN201710802805.1A CN201710802805A CN107521496B CN 107521496 B CN107521496 B CN 107521496B CN 201710802805 A CN201710802805 A CN 201710802805A CN 107521496 B CN107521496 B CN 107521496B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- control
- module
- transverse
- information
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 230000005540 biological transmission Effects 0.000 claims description 6
- 238000004422 calculation algorithm Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 238000005457 optimization Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000009825 accumulation Methods 0.000 claims description 2
- 230000008713 feedback mechanism Effects 0.000 claims description 2
- 230000007246 mechanism Effects 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 5
- 241000153246 Anteros Species 0.000 description 4
- 238000000205 computational method Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 238000012856 packing Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 239000002243 precursor Substances 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 239000000725 suspension Substances 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
- B60W30/10—Path keeping
-
- 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
- B60W30/14—Adaptive cruise control
-
- 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/0002—Automatic control, details of type of controller or control system architecture
-
- 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/0033—Single-track, 2D vehicle model, i.e. two-wheel bicycle model
-
- 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
-
- 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/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
- B60W2050/0052—Filtering, filters
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种无人车辆的横纵向协调控制轨迹跟随控制方法,其具体方法为:控制方法中的控制系统包括:信息接收模块,计算求解模块和控制命令发送模块,具体步骤为:步骤一、信息的接收,通过信息接收模块进行信息的接收,步骤二、求解计算:利用计算求解模块进行求解;步骤三、控制命令发送模块首先将前轮转角和车轮驱动/制动力矩转化为执行机构的直接控制量;有益效果:采用横纵向协调控制,建立了无人车辆横纵向运动关系,相对于横向和纵向单独控制,消除了横纵向运动耦合带来的控制误差,增加了控制系统的鲁棒性。
Description
技术领域
本发明涉及无人车辆控制技术领域,具体涉及一种无人车辆的横纵向协调控制轨迹跟随控制方法。
背景技术
目前,无人驾驶车辆理论上具有降低交通事故率、降低交通事故死亡率,提高能源利用率,缓解交通拥堵、提高道路通行量,减少个人通勤时间,给更多人提供方便,提高社会生产力等优点,成为国内外各大研究机构和科技企业的研究热点。无人驾驶车辆可以分为感知、决策和控制三个层面,在控制层中,需要将决策层输出的车辆轨迹转化为控制量从而使车辆能够精确跟随规划的轨迹。一般的横向或纵向控制多采用PID控制方法,虽然结构简单易于实现,但是存在依赖工程经验,需要调试过程等缺点,对于无人车辆来说显然存在很大的不合理,由于缺乏具体的模型,PID控制也很难做到控制的精确;PID控制的控制效果严重依赖于参数,因此对于控制车辆车速变化具有较差的鲁棒性。此外,现有的大多控制一般在控制层的策略为横向和纵向独立控制,但是车辆的横向和纵向运动具有较强的耦合性,忽略车辆自身横纵向运动的耦合进行独立控制往往也降低了控制的精确性,因此在独立控制中存在控制精度较差等问题。
发明内容
本发明的目的是为了解决在无人驾驶车辆控制过程中所存在的诸多问题而提供的一种无人车辆的横纵向协调控制轨迹跟随控制方法。
本发明提供的无人车辆的横纵向协调控制轨迹跟随控制方法,其具体方法如下:
控制方法中的控制系统包括:信息接收模块,计算求解模块和控制命令发送模块,具体步骤如下:
步骤一、信息的接收,通过信息接收模块进行信息的接收,信息接收模块分为两部分,一部分为无人车未来行驶轨迹接收部分,提供和决策层的接口,接受无人车辆决策系统输出的未来行驶的轨迹,然后将接收到的包含速度和相对大地坐标系位置、航向角的连续轨迹数据根据控制周期进行离散化后发送给计算求解模块;另一部分为车辆当前状态信息接收模块,接收传感器自身获取并发送的车辆相对大地坐标系的实际位置、车辆横纵向速度、横纵向加速度、车辆相对大地坐标系的航向角、车辆横摆角速率,然后将接收到的这些传感器信息利用卡尔曼滤波器滤除噪声后,传送给计算求解模块;
步骤二、计算求解:利用计算求解模块进行求解,利用经过简化的车辆两轮动力学模型和模型预测控制算法将信息接收模块传递来的轨迹信息和车辆状态信息,经过车辆状态预测、优化求解、反馈机制后求出控制时域内的最优解:前轮转角和车轮所需制动/驱动力矩,然后将求出的控制时域内的下一时刻的前轮转角增量和车轮驱动/制动力矩增量进行下一步计算,计算求解模块主要分为三部分,第一部分根据信息接收模块传递的当前车辆状态信息和车辆两轮模型的动力学分析建立准确的车辆动力学模型,根据所建立的动力学模型计算出预测时域内的车辆状态;第二部分根据信息接收模块传递的决策轨迹和预测的车辆状态做时间线对齐后计算出预测的控制偏差;第三部分为求解部分,根据上述得出的控制偏差和车辆动力学模型以及车辆自身的运动学和动力学约束利用二次规划进行求解,得出车辆横向控制所需的控制时域内的前轮转角增量序列和纵向控制所需的车轮驱动/制动转矩增量序列,之后将求出的控制时域内的下一时刻的前轮转角增量和车轮驱动/制动力矩增量传递给控制命令发送模块;
步骤三、控制命令发送模块首先将前轮转角增量和车轮驱动/制动力矩增量累加得到前轮转角和车轮驱动/制动绝对量,然后将前轮转角和车轮驱动/制动的绝对量转化为执行机构的直接控制量:方向盘转角和发动机扭矩或制动缸压力,然后打包通过控制局域网络发送给执行机构,从而通过对车辆横纵方向的协调控制实现对规划决策的轨迹准确跟随,通过各模块的协同工作,使得车辆能够准确跟踪决策层输出的轨迹。
上述方法中的信息接收模块,计算求解模块和控制命令发送模块均为现有设备的组装,因此,具体型号和规格没有进一步进行赘述。
本发明的有益效果:
本发明采用车辆两轮动力学模型对无人车辆进行精确的系统建模,相对与传统的PID控制算法因为拥有了较为精准的模型,减少了大量的参数整定过程,节约了大量的人力物力,采用模型预测控制算法求解控制时域内的最优解,增加了控制系统的精确度,采用横纵向协调控制,建立了无人车辆横纵向运动关系,相对于横向和纵向单独控制,消除了横纵向运动耦合带来的控制误差,增加了控制系统的鲁棒性。
附图说明
图1为本发明所述控制方法流程图。
图2为无人车辆两轮简化模型示意图。
具体实施方式
请参阅图1至图2所示:
首先为信息的接收;信息接收模块分为两部分,一部分为无人车未来行驶轨迹接收部分,提供和决策层的接口,接受无人车辆决策系统输出的未来行驶的轨迹,然后将接收到的包含速度和相对大地坐标系位置、航向角的连续轨迹数据根据控制周期进行离散化后发送给计算求解模块;另一部分为车辆当前状态信息接收模块,接收传感器自身获取并发送的车辆相对大地坐标系的实际位置、车辆横纵向速度、横纵向加速度、车辆相对大地坐标系的航向角、车辆横摆角速率,然后将接收到的这些传感器信息利用卡尔曼滤波器滤除噪声后,传送给计算求解模块。
然后是计算求解;首先以前轮驱动车辆两轮模型做动力学分析。采用车辆两轮模型的前提条件是做如下假设:(1)忽略悬架的作用,认为汽车车厢只作平行于地面的平面运动,即采用附图1中的车辆坐标系,汽车沿z轴的位移,绕y轴的俯仰和绕x轴的侧倾角均为零;(2)忽略转向系统的影响,以前轮转角作为输入;(3)车辆的侧向加速度在0.4g范围内,轮胎的侧偏特性处于线性区域内;(4)忽略纵向和横向的空气动力学;(5)车辆的行驶速度变化缓慢,忽略前后轴的载荷转移。
在上述假设下做车辆两轮如附图2。图中坐标系oxyz固定于车身,原点o固定于车辆质心位置,xoz处于车辆左右对称的平面内,x轴为车辆纵轴,y轴与车辆纵轴垂直,z轴满足右手准则。坐标系OXY为大地坐标系。前后轮分别建立各自的xy轴。在附图2中进行简化后的前后车轮进行受力分析:
Ffl、Ffc、Ffx、Ffy分别为车辆前轮坐标系中的纵向、侧向、x轴、y轴方向上的受力;
Frl、Frc、Frx、Fry分别为车辆后轮坐标系中的纵向、侧向、x轴、y轴方向上的受力;
δ为前轮转角,αf、αr分别为前后轮的轮胎侧偏角;
vf、vr分别为前后轮的速度;
x′、y′分别为车辆x轴、y轴方向上的速度;
a、b分别为车辆质心到前后轴的距离。
在车辆x轴方向上,
在车辆y轴方向上,
在车辆z轴方向上,
上式中,Iz为车辆绕z轴的转动惯量。
在轮胎坐标系中,x轴方向、y轴方向上的力与纵向力、侧向力的转换关系为:
Ffx=Fflcosδ-Ffcsinδ (公式4)
Ffy=Fflsinδ+Ffccosδ (公式5)
Frx=Frlcosδ+Frcsinδ (公式6)
Fry=Frccosδ-Frlsinδ (公式7)
上述公式中,δ为对应车轮x轴与车辆x轴的夹角,即车轮的转角。
轮胎的纵向力、侧向力可以表示为轮胎侧偏角、滑移率、路面系数和垂直载荷等参数的复杂函数:
Fl=fl(α,s,μ,Fz) (公式8)
Fc=fc(α,s,μ,Fz) (公式9)
上述公式中中,α为轮胎侧偏角,s为滑移率,μ为路面摩擦系数,Fz为轮胎所受到的垂直载荷。在车辆两轮模型的简化中,忽略前后轴质量的转移,则前后轴的垂直载荷为:
Ffz=(bmg)/(a+b) (公式10)
Frz=(amg)/(a+b) (公式11)
Pacejka提出的魔术公式表述了轮胎的纵向力Fl,侧向力Fc,回正力矩Mz,翻转力矩Mx,阻力矩My与侧偏角α,滑移率s之间的定量关系,以及纵向力、侧向力的联合作用工况,能够表达不同驱动情况时的轮胎特性。魔术公式的一般表达式为:
Y(x)=Dsin{Ctan-1[Bx-E(tan-1(Bx))]} (公式12)
上式中,系数B、C、D由轮胎的垂直载荷和外倾角确定;Y为输出变量,可以为纵向力Fl或侧向力Fc或回正力矩;x为输入变量,在不同的情况下分别表示轮胎的侧偏角α或纵向滑移率s;B为刚度因子,C为形状因子;D为峰值因子,E为曲率因子。在实际应用中,由于帘布层转向效应、侧偏力作用或滚动阻力会引起便宜,通常还会引入垂直偏移Sv和水平偏移Sh。
轮胎纵向力计算方法:
Fl=Dlsin[Cltan-1(Blxl-El(Blxl-tan-1(Blxl)))]+Sv (公式13)
上式中,xl=s+Sh,s为纵向滑移率,计算方法见(公式16)。Sh为曲线的水平方向漂移,Sv为曲线的垂直方向的漂移。Cl为曲线的形状因子,Cl=B0;Dl为曲线峰值因子,表示曲线的最大值,其中Fz为轮胎受到的垂直载荷;Bl为刚度因子,El为曲线的曲率因子,表示曲线最大值附近的形状,Sh为曲线水平方向的漂移:Sh=B9Fz+B10;Sv为曲线垂直方向漂移:Sv=0。
轮胎侧向力计算方法:
Fc=Dc sin[Cctan-1(Bcxc-Ec(Bcxc-tan-1(Bcxc)))]+Sv (公式14)
上式中,xc=α+Sh,α为轮胎侧偏角。Sh为曲线的水平方向漂移,Sv为曲线的垂直方向的漂移。Cc为曲线的形状因子,Cc=A0;Dc为曲线峰值因子,表示曲线的最大值,其中Fz为轮胎受到的垂直载荷;Bc为刚度因子,Bc=A3sin(2tan-1Fz/A4)*(1-A5|γ)/(Cc*Dc),其中γ为轮胎外倾角;Ec为曲线的曲率因子,Sh为曲线水平方向的漂移:Sh=A9Fz+A10+A8γ;Sv为曲线垂直方向漂移:Sv=A11Fzγ+A12Fz+A13。A0-A13和B1-B10为常数。
轮胎侧偏角的计算公式为:
α=tan-1(vc/vl) (公式15)
纵向滑移率的计算:
上式中,vl为纵向车轮速度,r和ω分别为车轮半径和角速度。
对车轮进行受力分析得到:
Idfω′f=-Fflr+Tf-Cwfωf (公式17)
Idrωr′=-Frlr+Tr-Cwrωr (公式18)
上式中,Idf为前轮的转动惯量,Tf为作为驱动轮的前轮的驱动力矩或制动力矩,Cwf为前轮及传动系的阻尼系数;Idr为后轮的转动惯量,Tr为作为从动轮的后轮的制动力矩(Tr≤0),Cwf为后轮及半轴的阻尼系数。
在(公式15)和(公式16)中,vl和vc为纵向和侧向车轮速度,可以表示为:
vl=vysinδ+vxcosδ (公式19)
vc=vycosδ-vxsinδ (公式20)
在车辆模型中,
vfx=x′ vrx=x′ (公式22)
在大地坐标系中存在如下关系:
Y′=x′sinψ+y′cosψ (公式23)
X′=x′cosψ-y′sinψ (公式24)
根据(公式1)-(公式24),建立基于车辆两轮模型的动力学状态方程:
ξ′(t)=f[ξ(t),u(t)] (公式25)
状态控制量u=[δf,Tf,Tr]。
输出方程:
η(t)=C(t)ξ(t) (公式26)
输出状态量η=[Y,X,ψ]。
根据上述建立的车辆动力学非线性方程采用模型预测算法对车辆进行横纵向协调控制。
受限于现有计算机的计算能力,对于非线性模型的模型预测控制算法计算周期远远大于无人车跟踪控制所需的控制周期,因此,对上述非线性动力学模型进行线性化,得到线性时变方程:
ξ′(t)=A(t)ξ(t)+B(t)u(t) (公式27)
式中,
在计算机中计算需要对上述线性连续方程进行离散化处理,得到:
ξ(k+1)=A(k)ξ(k)+B(k)u(k) (公式28)
式中,A(k)=I+TA(t),B(k)=TB(t)。
在模型预测控制的优化求解中需要建立约束条件:
(1)动力学模型为前驱车辆,所以后轮驱动力矩为0,制动力矩限定在车辆制动性能范围内,即:
-Tt,bmax≤Tr≤0 (公式29)
(2)前轮转角约束量:
δf,min≤δf≤δf,max (公式30)
(3)前轮转角增量限制:
δmin≤δ≤δmax (公式31)
(4)前轮制动/驱动力矩限制:
-Tf,bmax≤Tf≤Tf,dmax (公式32)
建立目标函数:
上式中,Np为预测时域,Nc为控制时域,ρ为权重系数,ε为松弛因子。
综合上述目标函数和约束条件,基于车辆两轮模型的横纵向协调控制轨迹跟随系统在每个控制周期内需要解决的问题为如下二次型优化问题:
s.t.:ΔUmin≤ΔU≤ΔUmax
完成上述求解后,得到控制时域内的一系列控制输入增量:
将上述控制序列中的第一个元素作为当前周期的实际控制量传递给命令发送模块,命令发送模块经过打包后发送给执行器,从而作用于车辆。
进入下一个控制周期后,重复求解上述优化问题,执行循环从而实现对期望轨迹的横纵向协同跟踪控制。
命令发送模块接收到的控制量为u(k)=[δf,Tf,Tr],δf为前轮转角,经过转向系统反向计算后得出方向盘转角:
δw=isδf (公式37)
上式中,is为转向系统的传动比。
Tf为前轴的驱动(Tf>0)或制动(Tf<0)力矩,经过传动系统的解算后得到动力机(发动机或电机)扭矩,或前轴制动缸压力
上式中,id为传动系统的传动比,kf为前轴制动缸压力换算系数。
Tf为后轴的制动力矩,
Pcyr=krTf (公式39)
上式中kr为前轴制动主缸压力换算系数。
命令发送模块通过控制局域网络将方向盘转角δf、动力机请求扭矩Treq或制动缸压力Pcyr、Pcyf发送给对应的执行机构,完成一个控制周期的控制过程。
Claims (1)
1.一种无人车辆的横纵向协调控制轨迹跟随控制方法,其特征在于:其具体方法如下:
控制方法中的控制系统包括:信息接收模块,计算求解模块和控制命令发送模块,具体步骤如下:
步骤一、信息的接收,通过信息接收模块进行信息的接收,信息接收模块分为两部分,一部分为无人车未来行驶轨迹接收部分,提供和决策层的接口,接受无人车辆决策系统输出的未来行驶的轨迹,然后将接收到的包含速度和相对大地坐标系位置、航向角的连续轨迹数据根据控制周期进行离散化后发送给计算求解模块;另一部分为车辆当前状态信息接收模块,接收传感器自身获取并发送的车辆相对大地坐标系的实际位置、车辆横纵向速度、横纵向加速度、车辆相对大地坐标系的航向角、车辆横摆角速率,然后将接收到的这些传感器信息利用卡尔曼滤波器滤除噪声后,传送给计算求解模块;
步骤二、计算求解:利用计算求解模块进行求解,利用经过简化的车辆两轮动力学模型和模型预测控制算法将信息接收模块传递来的轨迹信息和车辆状态信息,经过车辆状态预测、优化求解、反馈机制后求出控制时域内的最优解:前轮转角和车轮所需制动/驱动力矩,然后将求出的控制时域内的下一时刻的前轮转角增量和车轮驱动/制动力矩增量进行下一步计算,计算求解模块主要分为三部分,第一部分根据信息接收模块传递的当前车辆状态信息和车辆两轮模型的动力学分析建立准确的车辆动力学模型,根据所建立的动力学模型计算出预测时域内的车辆状态;第二部分根据信息接收模块传递的决策轨迹和预测的车辆状态做时间线对齐后计算出预测的控制偏差;第三部分为求解部分,根据上述得出的控制偏差和车辆动力学模型以及车辆自身的运动学和动力学约束利用二次规划进行求解,得出车辆横向控制所需的控制时域内的前轮转角增量序列和纵向控制所需的车轮驱动/制动转矩增量序列,之后将求出的控制时域内的下一时刻的前轮转角增量和车轮驱动/制动力矩增量传递给控制命令发送模块;
步骤三、控制命令发送模块首先将前轮转角增量和车轮驱动/制动力矩增量累加得到前轮转角和车轮驱动/制动绝对量,然后将前轮转角和车轮驱动/制动的绝对量转化为执行机构的直接控制量:方向盘转角和发动机扭矩或制动缸压力,然后打包通过控制局域网络发送给执行机构,从而通过对车辆横纵方向的协调控制实现对规划决策的轨迹准确跟随,通过各模块的协同工作,使得车辆能够准确跟踪决策层输出的轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710802805.1A CN107521496B (zh) | 2017-09-08 | 2017-09-08 | 一种无人车辆的横纵向协调控制轨迹跟随控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710802805.1A CN107521496B (zh) | 2017-09-08 | 2017-09-08 | 一种无人车辆的横纵向协调控制轨迹跟随控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107521496A CN107521496A (zh) | 2017-12-29 |
CN107521496B true CN107521496B (zh) | 2018-11-13 |
Family
ID=60683782
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710802805.1A Active CN107521496B (zh) | 2017-09-08 | 2017-09-08 | 一种无人车辆的横纵向协调控制轨迹跟随控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107521496B (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108284836B (zh) * | 2018-01-25 | 2019-12-24 | 吉林大学 | 一种车辆纵向跟随控制方法 |
CN108958246A (zh) * | 2018-06-29 | 2018-12-07 | 长安大学 | 无人车在U-Turn场景的轨迹跟踪控制方法 |
CN108674414B (zh) * | 2018-07-02 | 2019-11-08 | 清华大学 | 一种极限工况的智能汽车轨迹跟踪控制方法 |
US11372403B2 (en) * | 2018-11-05 | 2022-06-28 | Tusimple, Inc. | Systems and methods for dynamic predictive control of autonomous vehicles |
CN109977449B (zh) * | 2018-11-05 | 2023-08-22 | 江苏大学 | 智能汽车纵向动力学系统混杂动态建模与优化控制方法 |
CN109808707B (zh) * | 2019-02-19 | 2020-12-08 | 武汉理工大学 | 一种基于随机模型预测的汽车转向控制方法及控制器 |
CN110244721B (zh) * | 2019-06-05 | 2022-04-12 | 杭州飞步科技有限公司 | 自动驾驶控制方法、装置、设备及存储介质 |
CN112519882B (zh) * | 2019-09-17 | 2022-02-22 | 广州汽车集团股份有限公司 | 一种车辆参考轨迹跟踪方法及系统 |
EP4099118A4 (en) * | 2020-02-25 | 2023-01-25 | Huawei Technologies Co., Ltd. | VEHICLE CONTROL METHOD AND APPARATUS |
CN111583636B (zh) * | 2020-04-29 | 2022-03-11 | 重庆大学 | 一种基于车路协同的混合交通横纵耦合控制方法 |
CN112180925B (zh) * | 2020-09-28 | 2023-02-17 | 广东嘉腾机器人自动化有限公司 | Agv轨迹跟随方法、装置及处理设备 |
CN112050809B (zh) * | 2020-10-08 | 2022-06-17 | 吉林大学 | 轮式里程计与陀螺仪信息融合的无人车定向定位方法 |
CN112572473B (zh) * | 2020-12-09 | 2022-06-10 | 北京三快在线科技有限公司 | 一种无人驾驶设备的控制方法及装置 |
CN113359477B (zh) * | 2021-07-13 | 2021-12-21 | 吉林大学 | 一种车辆纵侧向耦合轨迹跟踪控制器设计方法 |
CN113788008B (zh) * | 2021-07-20 | 2023-06-27 | 浙江万安科技股份有限公司 | 一种基于纳什-mpc的集成底盘轨迹跟踪控制方法 |
CN113635920B (zh) * | 2021-09-17 | 2023-01-03 | 中国重汽集团济南动力有限公司 | 一种权重自适应横纵向耦合跟踪控制方法及系统 |
CN113830074A (zh) * | 2021-09-28 | 2021-12-24 | 中国科学技术大学先进技术研究院 | 基于极限工况的智能驾驶车辆纵横向控制方法和系统 |
CN114275039B (zh) * | 2021-12-27 | 2022-11-04 | 联创汽车电子有限公司 | 智能驾驶车辆横向控制方法和模块 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104063547A (zh) * | 2014-06-29 | 2014-09-24 | 吉林大学 | 基于云推理的汽车巡航车速规划方法 |
JP2015141101A (ja) * | 2014-01-29 | 2015-08-03 | アイシン・エィ・ダブリュ株式会社 | ナビゲーション装置、ナビゲーション方法及びプログラム |
GB2523666A (en) * | 2015-02-19 | 2015-09-02 | Daimler Ag | Hybrid vehicle |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102069804B (zh) * | 2010-12-25 | 2013-09-04 | 浙江吉利汽车研究院有限公司 | 一种混合动力汽车行驶状态预测控制方法 |
US9628565B2 (en) * | 2014-07-23 | 2017-04-18 | Here Global B.V. | Highly assisted driving platform |
JP2016090274A (ja) * | 2014-10-30 | 2016-05-23 | トヨタ自動車株式会社 | 警報装置、警報システム及び携帯端末 |
JP2016113093A (ja) * | 2014-12-17 | 2016-06-23 | ダイムラー・アクチェンゲゼルシャフトDaimler AG | ハイブリッド車両の制御装置 |
JP6579699B2 (ja) * | 2015-07-29 | 2019-09-25 | 株式会社Subaru | 車両の走行制御装置 |
CN106696956B (zh) * | 2015-11-11 | 2018-11-02 | 财团法人车辆研究测试中心 | 具路径误差修正的车辆轨迹追踪装置及方法 |
-
2017
- 2017-09-08 CN CN201710802805.1A patent/CN107521496B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015141101A (ja) * | 2014-01-29 | 2015-08-03 | アイシン・エィ・ダブリュ株式会社 | ナビゲーション装置、ナビゲーション方法及びプログラム |
CN104063547A (zh) * | 2014-06-29 | 2014-09-24 | 吉林大学 | 基于云推理的汽车巡航车速规划方法 |
GB2523666A (en) * | 2015-02-19 | 2015-09-02 | Daimler Ag | Hybrid vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN107521496A (zh) | 2017-12-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107521496B (zh) | 一种无人车辆的横纵向协调控制轨迹跟随控制方法 | |
CN107380161B (zh) | 一种辅助驾驶员实现理想行驶轨迹的主动转向控制装置 | |
CN104773170B (zh) | 一种车辆稳定性集成控制方法 | |
CN108248605A (zh) | 一种智能车辆轨迹跟随的横纵向协调控制方法 | |
CN104773169B (zh) | 一种基于轮胎侧偏角的车辆横摆稳定集成控制方法 | |
CN110827535B (zh) | 非线性车辆队列协同自适应抗扰纵向控制方法 | |
CN107512262B (zh) | 一种针对执行驱动空间受限时的车辆稳定控制系统轮胎力分配方法 | |
CN101193785B (zh) | 车辆控制装置 | |
CN109976159A (zh) | 基于安全可控域的智能车辆横向控制方法 | |
CN107804315A (zh) | 一种考虑驾驶权实时分配的人车协同转向控制方法 | |
CN102303602B (zh) | 乘用车平顺性与操稳性协调方法及控制装置 | |
CN109969183A (zh) | 基于安全可控域的弯道跟车控制方法 | |
Subosits et al. | Autonomous vehicle control for emergency maneuvers: The effect of topography | |
Chen et al. | Trajectory tracking control of steer-by-wire autonomous ground vehicle considering the complete failure of vehicle steering motor | |
CN101321654A (zh) | 车辆控制装置 | |
CN108732921A (zh) | 一种自动驾驶汽车横向可拓预瞄切换控制方法 | |
CN105644566B (zh) | 一种基于车联网的电动汽车辅助换道轨迹的跟踪方法 | |
CN110239519A (zh) | 一种车辆爆胎过程的协调控制方法 | |
CN103600744A (zh) | 四轮转向/驱动车辆的路径保持和车轮侧滑的控制方法 | |
CN114312848B (zh) | 基于双层mpc的智能驾驶汽车轨迹规划与跟踪控制方法 | |
Wang et al. | Integrated path tracking control of steering and differential braking based on tire force distribution | |
CN109334672A (zh) | 一种智能电动汽车路径跟踪和直接横摆力矩协同控制方法 | |
CN109017805A (zh) | 一种针对存在不确定性的行驶系统车辆稳定性控制方法 | |
CN106347361A (zh) | 一种冗余驱动车辆动力学控制分配方法 | |
CN108594830A (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 |