CN107161207B - 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法 - Google Patents

一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法 Download PDF

Info

Publication number
CN107161207B
CN107161207B CN201710318031.5A CN201710318031A CN107161207B CN 107161207 B CN107161207 B CN 107161207B CN 201710318031 A CN201710318031 A CN 201710318031A CN 107161207 B CN107161207 B CN 107161207B
Authority
CN
China
Prior art keywords
vehicle
control
dyn
model
intelligent automobile
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
Application number
CN201710318031.5A
Other languages
English (en)
Other versions
CN107161207A (zh
Inventor
蔡骏宇
江浩斌
陈龙
王俊彦
蔡英凤
徐兴
李傲雪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu University
Original Assignee
Jiangsu University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Jiangsu University filed Critical Jiangsu University
Priority to CN201710318031.5A priority Critical patent/CN107161207B/zh
Publication of CN107161207A publication Critical patent/CN107161207A/zh
Application granted granted Critical
Publication of CN107161207B publication Critical patent/CN107161207B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D5/00—Power-assisted or power-driven steering
    • B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
    • B62D5/046—Controlling the motor
    • 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
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles

Abstract

本发明公开了一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法，属于智能车辆自动驾驶领域。控制系统包括基于模型预测控制的轨迹跟踪控制单元和具有主动安全功能的线控转向单元，轨迹跟踪控制单元可实时获取车辆的精确位置与方向盘转角，从而获取车辆的姿态信息；结合目标轨迹参数计算出车辆的目标前轮转角，线控转向控制单元根据该目标前轮转角，实现对转向执行电机的精确控制；同时对车辆可能出现的侧翻危险进行预测，并进行主动前轮转角补偿控制，最终实现车辆的轨迹跟踪控制。本发明通过将模型预测控制理论与基于主动安全的线控转向技术相结合，保证智能汽车的可靠性，实现智能汽车在高速行驶时的轨迹跟踪控制。

Description

一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法
技术领域
本发明属于智能车辆自动驾驶领域，具体涉及一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法。
背景技术
汽车的智能化主要体现在以自动驾驶替代人工操作，汽车的行为和运行状态均可控可预测，既降低驾驶员的操作强度，又减少了交通事故发生率，根据实时路况信息规划出行路径，使车辆在道路上高效的行驶，最终实现道路交通“零伤亡、零拥堵”。因此，智能汽车是安全、高效、节能的下一代汽车，研究智能汽车具有极为重要的意义，已成为全球汽车产业界的关注焦点。目前已经投入使用的具有自动驾驶功能的车辆如码头无人驾驶车辆或带自动泊车功能的车辆的行驶环境处于低速、特定场合使用，但智能汽车需要以较高的车速行驶在复杂的道路环境中。使用车辆动力学模型对对车辆的未来行为进行预测，可以提高智能汽车高速下的可靠性与预测能力；同时，与低速行驶相比高速行驶下的执行机构控制输入、轮胎与地面摩擦引起的滑移，以及横向加速度引起的侧倾等动力学非线性约束条件的要求更加严格。对这些约束进行深入分析将进一步保障车辆形式的安全性与稳定性。本发明将建立基于车辆动力学模型的轨迹跟踪控制器，结合车辆高速运动下的各类约束，求解复杂约束条件下的模型预测控制方法。现有的技术中，存在以下技术问题：(1)大多数装置成本较高；(2)大多数只是进行单纯的仿真研究，没有考虑真正的执行机构运行时的安全问题；(3)智能汽车转向工况复杂多变，汽车转向操纵对各工况的控制要求较高，传统的控制策略无法满足高速行驶情况下的车辆稳定性与安全性。
为了保证智能汽车高速行驶在复杂交通环境下的安全性与稳定性，本发明具体开发了一套基于主动安全的智能汽车轨迹跟踪控制系统。首先建立了基于线性时变模型预测控制算法的轨迹跟踪控制单元，结合各动力学约束，得出前轮转角理想值，为了进一步保证车辆运行的安全性，主动安全转向系统根据前轮转角理想值，进行基于侧翻预警的主动前轮转角补偿控制，以达到避免车辆侧翻的目标。
发明内容
为解决现有技术存在的不足，本发明提供了一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法，在轨迹跟踪控制单元的基础上结合主动安全线控转向单元，最终达到车辆在高速复杂路况下的稳定性与安全性的要求。
本发明是通过以下技术方案实现上述技术目的。
一种基于主动安全的智能汽车轨迹跟踪控制系统，包括基于模型预测控制的轨迹跟踪控制单元和具有主动安全功能的线控转向单元，所述轨迹跟踪控制单元与线控转向单元通信；
所述轨迹跟踪控制单元包括第一GPS天线、第一电台、第二电台、第二GPS天线、惯导系统、智能终端、方向盘转角传感器及前轮转角传感器，所述第一GPS天线与第一电台组成基准站，所述第二电台与第二GPS天线组成流动站，所述惯导系统采集惯导数据，所述流动站获取智能汽车的初始位置数据并接收基准站发送的差分信号对初始位置数据进行差分后，通过惯导数据校正智能汽车的精确位置数据并发送给智能终端，所述智能终端还通过串口接收方向盘转角传感器、前轮转角传感器采集的方向盘转角、前轮转角，从而计算出智能汽车的目标转角；
所述线控转向单元包括MCU、电机驱动器及转向执行电机，所述MCU接收智能汽车的目标转角并修正，然后通过CAN总线将修正后的目标转角发送给电机驱动器，电机驱动器通过串口与转向执行电机通信，控制智能汽车，达到车辆路径跟踪的目的。
上述方案中，所述轨迹跟踪控制单元与线控转向单元通过USB转RS232串口通信。
上述方案中，所述流动站安装在智能汽车上。
上述方案中，所述第一GPS天线实时测量出基准站的位置并与测定位置进行计算得出差分信号，第一电台将差分信号发送至第二电台。
上述方案中，所述MCU采用MC9S12XET256芯片。
一种基于主动安全的智能汽车轨迹跟踪控制方法，包括以下步骤：
S1，建立三自由度非线性车辆动力学模型，将车辆四轮模型简化为单车模型，并选择车辆的状态量ξdyn与控制量udyn；
S2，对非线性车辆动力学模型进行线性化，得到线性时变方程；
S3，采用一阶差商的方法进行对线性时变方程进行离散化处理，得到离散的状态空间表达式；
S4，设计目标函数使得智能汽车能够快速且平稳地追踪期望轨迹；
S5，考虑每个控制周期内基于非线性车辆动力学模型的轨迹跟踪控制算法的优化问题，包括控制量的约束：控制增量与控制量的约束，车辆动力学约束：质心侧偏角约束、轮胎侧偏角的约束与车辆附着条件约束；
S6，在每个控制周期内求解优化问题后得到控制时域Nc内理想的控制输入增量序列将此序列中的第一个元素与上一时刻的控制量相加，得到最终的控制量udyn(t)；
S7，建立车辆四自由度侧翻模型，根据横向载荷转移率LTR来判断汽车侧翻危险程度；
S8，利用自回归模型，对侧翻判别指示横向载荷转移率LTR进行预测。
进一步，所述S2中线性时变方程为ξdyn＝Adyn(t)ξdyn(t)+Bdyn(t)udyn(t)，其中Adyn，Bdyn为t时刻线性车辆动力学模型的转移矩阵。
进一步，所述S3中离散的状态空间表达式为ξdyn(k+1)＝Adyn(k)ξdyn(k)+Bdyn(k)udyn(k)，其中Adyn(k)＝I+TAdyn(t)，Bdyn(k)＝I+TBdyn(t)，I为单位矩阵，T为采样时间。
进一步，所述S7中横向载荷转移率LTR的表达式为：其中Fz1和Fz2分别为智能汽车左侧车轮和右侧车轮上的垂直载荷。
进一步，所述S8具体为：
S8.1，根据自回归模型定义可得自回归预测公式为其中xN+i为预测值，xN-1+i xN-2+i…xN-p+i为已知的观测值，p是模型阶数；/>是模型参数；
S8.2，利用艾克准则来确定模型阶数p，模型阶数p的确定方法为IP＝log[Sp(N)/N]+2p/N和其中模型阶数p＝1,2...M，M为所设模型阶数的最大值；N是建模预测需要的已知数据个数；观察I1、I2...IM，其中最小的Ip即为最小模型阶数；Sp(N)为模型残差平方和；
S8.3，模型阶数p确定后，采用递推最小二乘法进行预测模型参数的估计，模型参数的最小二乘法估计值/>可表示为/>
S8.4，采用模糊PI控制算法，由实际横向载荷转移率LTR值和LTR阀值的偏差e、偏差的化率ec共同决定的，模糊PI控制器的输入为实际横向载荷转移率LTR值与LTR阀值的偏差e、偏差变化率ec，PI控制的比例系数kp和微分系数ki均为模糊PI控制器的输出。
本发明的有益效果是：
(1)本发明开发了一套基于主动安全的智能汽车轨迹跟踪控制系统，其中的智能终端实时获取车辆的精确位置与目标转角从而获取车辆的姿态信息，实现车辆对目标轨迹的跟踪。
(2)本发明设计的考虑各动力学约束的轨迹跟踪控制单元性能较好，通过选择先进的差分算法能够精确获得车辆的行驶轨迹，并且设计的轨迹跟踪控制方法能够快速的在不同车速下完成对期望轨迹的跟踪，轨迹跟踪控制单元对解决智能汽车在高速行驶时的轨迹跟踪控制问题具有独特的优势，对路面附着条件、车速变化和参考轨迹具有良好的鲁棒性和适应性。
(3)本发明设计的线控转向控制单元的可行性且超调量小、稳定性好，线控转向可以自由的进行前轮转角的设计，由于汽车的稳定性能和汽车的转向存在着巨大的联系，本发明将线控转向技术与汽车主动安全技术相关联，研究其控制方法；可以减小汽车侧翻危险工况下的横摆角速度和侧向加速度，进一步提升汽车的稳定性能与主动安全性能。
(4)本发明设计的整个系统控制方法具有可行性，采用的无线电台通信抗干扰能力强，并且能够保证车辆在高速行驶时的稳定性，未来将转向系统改装至车辆上是可行的。
附图说明
图1为一种基于主动安全的智能汽车轨迹跟踪控制系统的整体硬件框架图；
图2为一种基于主动安全的智能汽车轨迹跟踪控制系统的硬件实物图，图2(a)为第二电台3、第二GPS天线4与惯导系统5的安装实物图，图2(b)为方向盘转角传感器8的安装实物图，图2(c)为试验车辆实物图，图2(d)为MCU10的实物图；
图3为一种基于主动安全的智能汽车轨迹跟踪控制系统的控制原理图；
图4为三自由度非线性车辆动力学模型图；
图5为车辆四自由度侧翻模型图，图5(a)为车辆四自由度侧翻模型主视图，图5(b)为车辆四自由度侧翻模型侧视图；
图6为LTR偏差e、LTR偏差变化率ec与比例系数kp、ki的模糊规则曲面图，图6(a)为LTR误差e、LTR误差变化率ec与比例系数kp的模糊规则曲面图，图6(b)为LTR误差e、LTR误差变化率ec与微分系数ki的模糊规则曲面图；
图7为三角隶属度函数图，图7(a)为误差隶属函数图，图7(b)为误差微分隶属函数图。
具体实施方式
下面结合附图以及具体实施例对本发明作进一步的说明，但本发明的保护范围并不限于此。应当注意的是，下述实施例中描述的技术特征或者技术特征的组合不应当被认为是孤立的，它们可以被相互组合从而达到更好的技术效果。
如图1所示，一种基于主动安全的智能汽车轨迹跟踪控制系统，包括基于模型预测控制的轨迹跟踪控制单元和具有主动安全功能的线控转向单元，所述轨迹跟踪控制单元与线控转向单元通过USB转RS232串口通信；
轨迹跟踪控制单元包括第一GPS天线1、第一无线电台2、第二无线电台3、第二GPS天线4、惯导系统5、智能终端6、电源7、方向盘转角传感器8及前轮转角传感器9，第一GPS天线1与第一电台2组成基准站，第二电台3与第二GPS天线4组成流动站(安装在智能汽车上)，惯导系统5采集惯导数据，流动站获取智能汽车的初始位置数据，并接收基准站发送的差分信号对初始位置数据进行差分后，通过惯导数据校正智能汽车的精确位置数据并发送给智能终端6；智能终端6还通过串口接收方向盘转角传感器8、前轮转角传感器9采集的方向盘转角、前轮转角，从而计算出智能汽车的目标转角；电源7用于给流动站、惯导系统5供电；智能终端6能够完成车辆运行状态的感知、组合导航定位及路径跟踪控制目标值计算；本实施例的基准站测定位置为[32.1984725306，119.5137124611，103.888]，安装于江苏大学三江楼楼顶。
线控转向单元包括主动安全线控转向控制器MCU 10、电机驱动器11及转向执行电机12，MCU10采用MC9S12XET256芯片；主动安全线控转向控制器MCU 10接收智能汽车的目标转角并通过主动安全线控转向算法修正，然后通过CAN总线将修正后的目标转角发送给电机驱动器11，电机驱动器11通过串口与转向执行电机12通信，控制智能汽车，达到车辆路径跟踪的目的。
如图2所示为一种基于主动安全的智能汽车轨迹跟踪控制系统的实物硬件，其中(a)为第二电台3、第二GPS天线4与惯导系统5安装实物图，(b)为方向盘转角传感器8安装实物图，(c)为试验车辆，(d)为MCU10的实物图。
一种基于主动安全的智能汽车轨迹跟踪控制系统的工作过程为:
基准站向流动站发送差分信号，流动站接收差分信号后对获取的智能汽车初始位置数据进行差分，通过惯导系统5采集的惯导数据校正智能汽车的精确位置数据并发送给智能终端6；方向盘转角传感器8采集方向盘转角、前轮转角传感器9采集前轮转角，并通过串口传输给智能终端6，智能终端6根据基于轨迹跟踪控制算法计算出智能汽车的目标转角并发送给主动安全线控转向控制器MCU 10，主动安全线控转向控制器MCU 10通过主动安全线控转向控制算法对目标转角进行修正，然后通过CAN总线将修正后的目标转角发送给电机驱动器11，电机驱动器11通过串口与转向执行电机12通信，控制智能汽车。
结合图3本发明的控制原理图，说明一种基于主动安全的智能汽车轨迹跟踪控制方法，包括以下步骤：
S1，建立三自由度非线性车辆动力学模型，将车辆四轮模型简化为单车模型，如图4所示，且假设左侧车轮与右侧车轮路面摩擦系数、侧偏角、滑移率相等，并选择车辆的状态量ξdyn与控制量udyn；
非线性车辆动力学模型为：
其中：m为车辆整体质量，为车辆质心横向加速度，/>为车辆质心纵向速度，/>为车辆横摆角速度，Ccf为前轮胎侧偏刚度，δf为前轮偏转角，/>为车辆质心横向速度，a，b分别为车辆质心到前、后轴的距离，Ccr为后轮胎侧偏刚度，/>为车辆质心纵向加速度，Clf、Clr为前、后轮胎纵向刚度，I为车辆绕z轴的转动惯量，/>为车辆的横摆角加速度，/>分别为车辆质心在x与y轴方向上的速度，/>为车辆的横摆角；sf、sr分别是前轮与后轮的滑移率。
在该控制系统中，状态量ξdyn选取，控制量udyn选取udyn＝δf，其中X、Y为车辆质心的位置坐标。
S2，对非线性车辆动力学模型进行线性化，得到线性时变方程；
ξdyn＝Adyn(t)ξdyn(t)+Bdyn(t)udyn(t) (6)
其中Adyn，Bdyn为t时刻线性动力学模型的转移矩阵；且
其中：δf，t-1为t-1时刻的前轮转角，为t时刻的车辆横摆角速度，Iz为车辆绕z轴的转动惯量；/>为t时刻车辆质心纵向速度与横向速度，/>为t时刻车辆的横摆角；为前轮横向速度，/>为前轮角速度。
S3，采用一阶差商的方法对线性时变方程进行离散化处理，得到离散的状态空间表达式；
ξdyn(k+1)＝Adyn(k)ξdyn(k)+Bdyn(k)udyn(k) (7)
式中，Adyn(k)＝I+TAdyn(t)，Bdyn(k)＝I+TBdyn(t)，I为单位矩阵，T为采样时间，k为第k个，k＝1，2，3……。
S4，设计目标函数使得智能汽车能够快速且平稳地追踪期望轨迹，目标函数中的前两项分别反映了系统对目标轨迹的快速跟踪能力与对前轮转角平稳变化的要求，由于预测模型为复杂的车辆动力学模型，会有可能影响系统输出的连续性，所以为了解决这个问题，在目标函数中又引入了松弛因子；
目标函数为：
式中：Np为预测时域，Nc为控制时域，ρ为权重系数，ε为松弛因子，Q和R为权重系数，ΔUdyn为控制量变化量，ηdyn为系统输出，ηdyn，ref为系统参考输出。
S5，考虑每个控制周期内基于非线性车辆动力学模型的轨迹跟踪控制算法的优化问题，包括控制量的约束：控制增量与控制量的约束，车辆动力学约束：质心侧偏角约束、轮胎侧偏角的约束与车辆附着条件约束；
优化问题与约束为：
s.t.ΔUdyn，min≤ΔUdyn，t≤ΔUdyn，max
Udyn，min≤AΔUdyn，t+Udyn，t≤Udyn，max
yhc，min≤yhc≤yhc，max
ysc，min-ε≤ysc≤yhs，max+ε
ε＞0
其中：A为状态转移矩阵，yhc为硬约束输出，ysc为软约束输出。
S6，在每个控制周期内求解优化问题后得到控制时域Nc内理想的控制输入增量序列将此序列中的第一个元素与上一时刻的控制量相加，得到最终的控制量udyn(t)；
控制输入增量序列为：
最终控制量为：
S7，建立车辆四自由度侧翻模型，如图5所示，根据横向载荷转移率LTR来判断汽车侧翻危险程度；
横向载荷转移率LTR表达式为：
上式中Fz1和Fz2分别为汽车左侧车轮和右侧车轮上的垂直载荷，LTR取值区间在[-1，1]之间；当LTR为0时表示汽车左右两侧车轮的垂直载荷相等，汽车运行状况良好；当LTR等于1或者-1时，表示Fz1或者Fz2为0，这样则有一侧车轮已经快要脱离地面，所以车辆将会发生或刚好发生侧翻危险；LTR作为侧翻判别指示时，其阀值为0.8，若实时LTR值大于0.8则就需要进行转向控制了。假设侧倾角很小，则cos2φ≈1，sinφ≈0，/>得出：
式中：ay为汽车侧向加速度、φ为汽车侧倾角、g为重力加速度、为侧倾角速度、/>为侧倾角加速度、/>为纵向车辆加速度、D为轮距、h为簧载质量重心到侧倾重心距离、ω为横摆角速度、u为横向车辆速度。
S8，利用自回归模型，对侧翻判别指示横向载荷转移率LTR进行预测；
S8.1，根据自回归模型定义可得自回归预测公式为：
其中xN+i为预测值；xN-1+i xN-2+i … xN-p+i为已知的观测值；p是模型阶数，其值为1、2、3…；。
S8.2，在实时预测系统中模型阶数太高必然增加计算量，模型阶数太小则会降低预测精度，在实际工程应用中国通常利用艾克准则(Akaike Information Criterion,AIC)来确定模型的阶数，其模型阶数确定方法为：
IP＝log[Sp(N)/N]+2p/N (15)
其中模型阶数p＝1,2...M，M为所设的模型阶数的最大值；N是建模预测需要的已知数据个数；观察I1、I2...IM，其中最小的Ip即为最小模型阶数；Sp(N)为模型残差平方和，通常设立一个模型最大阶数M，然后依次计算I1、I2...IM，使得Ip最小的那个阶数，就是所需最优阶数。
S8.3，模型阶数p确定后，采用递推最小二乘法进行预测模型参数的估计；
模型参数的最小二乘法估计值/>可表示为：/>
S8.4，前轮转角安全补偿模糊PI控制是由实际横向载荷转移率LTR值和LTR阀值的偏差e、偏差的化率ec共同决定的，模糊PI控制器的输入为实际横向载荷转移率LTR值与LTR阀值的偏差e、偏差变化率ec，PI控制的比例系数kp和微分系数ki均为模糊PI控制器的输出；模糊语言变量子集为[NB,NM,NS,Z,PS,PM,PB]，分别表示{负大，负中，负小，零，正小，正中，正大}；实际横向载荷转移率LTR值和LTR阀值的偏差e的论域为(-0.2,0.2)，偏差率ec的论域为(-3,3)，PI控制的比例系数和微分系数kp、ki论域均为(30,40)。
本发明的模糊推理采用Mamdani推理的方法(即模糊推理的本质就是将一个给定输入空间通过模糊逻辑的方法映射到一个特定的输出空间的计算过程)，为了便于算法的实现，本发明模糊推理输入均采用了三角隶属度函数。得到LTR偏差e、LTR偏差变化率ec与比例系数kp、ki的模糊规则曲面图如图6所示，图6(a)为LTR偏差e、LTR偏差变化率ec与比例系数kp的模糊规则曲面图，图6(b)为LTR偏差e、LTR偏差变化率ec与比例系数ki的模糊规则曲面图；三角隶属度函数如图7，图7(a)为误差隶属函数图，图7(b)为误差微分隶属函数图。
本发明虽然已经给出了一些实施例，但是本领域的技术人员应当理解，在不脱离本发明精神的情况下，可以对本文的实施例进行改变。上述实施例只是示例性的，不应以本文的实施例作为本发明权利范围的限定。

Claims (9)

1.一种基于主动安全的智能汽车轨迹跟踪控制方法，其特征在于，包括以下步骤：
S1，建立三自由度非线性车辆动力学模型，将车辆四轮模型简化为单车模型，并选择车辆的状态量ξdyn与控制量udyn；
所述三自由度非线性车辆动力学模型具体为：
其中：m为车辆整体质量，为车辆质心横向加速度，/>为车辆质心纵向速度，/>为车辆横摆角速度，Ccf为前轮胎侧偏刚度，δf为前轮偏转角，/>为车辆质心横向速度，a，b分别为车辆质心到前、后轴的距离，Ccr为后轮胎侧偏刚度，/>为车辆质心纵向加速度，Clf、Clr为前、后轮胎纵向刚度，I为车辆绕z轴的转动惯量，/>为车辆的横摆角加速度，/>分别为车辆质心在x与y轴方向上的速度，/>为车辆的横摆角；sf、sr分别是前轮与后轮的滑移率；
状态量ξdyn选取控制量udyn选取udyn＝δf，其中X、Y为车辆质心的位置坐标；
S2，对非线性车辆动力学模型进行线性化，得到线性时变方程：
其中Adyn(t)，Bdyn(t)为t时刻线性车辆动力学模型的转移矩阵；且：
其中：δf，t-1为t-1时刻的前轮转角，为t时刻的车辆横摆角速度，Iz为车辆绕z轴的转动惯量；/>为t时刻车辆质心纵向速度与横向速度，/>为t时刻车辆的横摆角； 为前轮横向速度，/>为前轮角速度；
S3，采用一阶差商的方法进行对线性时变方程进行离散化处理，得到离散的状态空间表达式；
S4，设计目标函数使得智能汽车能够快速且平稳地追踪期望轨迹；
S5，针对每个控制周期内基于非线性车辆动力学模型的轨迹跟踪控制算法的优化问题，设计控制量的约束，包括控制增量与控制量的约束，以及设计车辆动力学约束，包括：质心侧偏角约束、轮胎侧偏角的约束与车辆附着条件约束；
S6，在每个控制周期内求解优化问题后得到控制时域Nc内理想的控制输入增量序列将此序列中的第一个元素与上一时刻的控制量相加，得到最终的控制量udyn(t)；
控制输入增量序列为：
最终控制量为：
S7，建立车辆四自由度侧翻模型，根据横向载荷转移率LTR来判断汽车侧翻危险程度；
S8，利用自回归模型，对侧翻判别指示横向载荷转移率LTR进行预测。
2.根据权利要求1所述的一种基于主动安全的智能汽车轨迹跟踪控制方法，其特征在于，所述S3中离散的状态空间表达式为ξdyn(k+1)＝Adyn(k)ξdyn(k)+Bdyn(k)udyn(k)，其中Adyn(k)＝I+TAdyn(t)，Bdyn(k)＝I+TBdyn(t)，I为单位矩阵，T为采样时间。
3.根据权利要求1所述的一种基于主动安全的智能汽车轨迹跟踪控制方法，其特征在于，所述S7中横向载荷转移率LTR的表达式为：其中Fz1和Fz2分别为智能汽车左侧车轮和右侧车轮上的垂直载荷。
4.根据权利要求1所述的一种基于主动安全的智能汽车轨迹跟踪控制方法，其特征在于，所述S8具体为：
S8.1，根据自回归模型定义可得自回归预测公式为其中xN+i为预测值，xN-1+i xN-2+i … xN-p+i为已知的观测值，p是模型阶数；/>是模型参数；
S8.2，利用艾克准则来确定模型阶数p，模型阶数p的确定方法为IP＝log[Sp(N)/N]+2p/N和其中模型阶数p＝1,2...M，M为所设模型阶数的最大值；N是建模预测需要的已知数据个数；观察I1、I2...IM，其中使得Ip最小的阶数即为确定的模型阶数；Sp(N)为模型残差平方和；
S8.3，模型阶数p确定后，采用递推最小二乘法进行预测模型参数的估计，模型参数的最小二乘法估计值/>表示为/>
S8.4，采用模糊PI控制算法，前轮转角安全补偿模糊PI控制由实际横向载荷转移率LTR值和LTR阀值的偏差e、偏差的化率ec共同决定的，模糊控制的输入为实际横向载荷转移率LTR值与LTR阀值的偏差e、偏差变化率ec，PI控制的比例系数kp和微分系数ki均为模糊控制的输出。
5.一种用于实现权利要求1-4任一项所述的基于主动安全的智能汽车轨迹跟踪控制方法的系统，其特征在于，包括基于模型预测控制的轨迹跟踪控制单元和具有主动安全功能的线控转向单元，所述轨迹跟踪控制单元与线控转向单元通信；
所述轨迹跟踪控制单元包括第一GPS天线(1)、第一电台(2)、第二电台(3)、第二GPS天线(4)、惯导系统(5)、智能终端(6)、方向盘转角传感器(8)及前轮转角传感器(9)，所述第一GPS天线(1)与第一电台(2)组成基准站，所述第二电台(3)与第二GPS天线(4)组成流动站，所述惯导系统(5)采集惯导数据，所述流动站获取智能汽车的初始位置数据并接收基准站发送的差分信号对初始位置数据进行差分后，通过惯导数据校正智能汽车的精确位置数据并发送给智能终端(6)，所述智能终端(6)还通过串口接收方向盘转角传感器(8)、前轮转角传感器(9)采集的方向盘转角、前轮转角，从而计算出智能汽车的目标转角；
所述线控转向单元包括MCU(10)、电机驱动器(11)及转向执行电机(12)，所述MCU(10)接收智能汽车的目标转角并修正，然后通过CAN总线将修正后的目标转角发送给电机驱动器(11)，电机驱动器(11)通过串口与转向执行电机(12)通信，控制智能汽车，达到车辆路径跟踪的目的。
6.根据权利要求5所述的系统，其特征在于，所述轨迹跟踪控制单元与线控转向单元通过USB转RS232串口通信。
7.根据权利要求5所述的系统，其特征在于，所述流动站安装在智能汽车上。
8.根据权利要求5所述的系统，其特征在于，所述第一GPS天线(1)实时测量出基准站的位置并与测定位置进行计算得出差分信号，第一电台(2)将差分信号发送至第二电台(3)。
9.根据权利要求5所述的系统，其特征在于，所述MCU(10)采用MC9S12XET256芯片。
CN201710318031.5A 2017-05-08 2017-05-08 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法 Active CN107161207B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710318031.5A CN107161207B (zh) 2017-05-08 2017-05-08 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710318031.5A CN107161207B (zh) 2017-05-08 2017-05-08 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法

Publications (2)

Publication Number Publication Date
CN107161207A CN107161207A (zh) 2017-09-15
CN107161207B true CN107161207B (zh) 2023-08-22

Family

ID=59812878

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710318031.5A Active CN107161207B (zh) 2017-05-08 2017-05-08 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法

Country Status (1)

Country Link
CN (1) CN107161207B (zh)

Families Citing this family (35)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108099919B (zh) * 2017-11-09 2019-01-29 珠海格力电器股份有限公司 车辆防侧翻预警方法、装置、存储介质及车辆
CN107745814B (zh) * 2017-11-15 2023-12-22 航宇救生装备有限公司 一种用于空投系统着陆的主动防翻控制机构
KR102429959B1 (ko) * 2017-12-11 2022-08-09 현대자동차주식회사 차량용 주행 제어시스템 및 방법
CN108334086B (zh) * 2018-01-25 2021-06-22 江苏大学 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法
CN108216028B (zh) * 2018-01-25 2021-09-21 华南理工大学 一种基于智能终端的车辆侧翻安全态势评估系统
CN108646734B (zh) * 2018-04-27 2021-04-02 天津大学 基于量子粒子群算法的非线性模型预测控制方法
CN108508899A (zh) * 2018-05-07 2018-09-07 湖北汽车工业学院 一种无人驾驶车辆轨迹跟踪控制行驶系统
CN112236732B (zh) * 2018-05-30 2022-04-19 西门子工业软件公司 控制自主车辆设备重复遵循相同预定轨迹的方法和系统
CN110789523A (zh) * 2018-08-01 2020-02-14 上海汽车集团股份有限公司 一种轨迹规划方法及装置
CN109292018B (zh) * 2018-09-13 2021-01-12 吉林大学 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法
CN109358621B (zh) * 2018-09-30 2019-05-07 山东省计算中心（国家超级计算济南中心） 自动驾驶汽车轨迹跟踪控制方法
EP3650298B1 (en) * 2018-11-12 2024-03-27 Infosys Limited System for integrated auto-steering and auto-braking mechanism in autonomous vehicles as a retro fit
US20200148261A1 (en) * 2018-11-14 2020-05-14 Steering Solutions Ip Holding Corporation Lane change and collision avoidance system
CN109823348B (zh) * 2019-02-19 2021-04-30 百度在线网络技术（北京）有限公司 无人车倒车模型控制方法、装置、设备及计算机可读介质
CN110147098A (zh) * 2019-04-30 2019-08-20 杭州飞步科技有限公司 自动驾驶车辆的控制方法、装置、设备及可读存储介质
CN110194213B (zh) * 2019-05-09 2023-11-24 上海工程技术大学 汽车防侧翻系统
CN110211376A (zh) * 2019-05-28 2019-09-06 成都谷辘信息技术有限公司 一种危险品运输车辆监控预警系统
CN110161865B (zh) * 2019-06-13 2021-04-20 吉林大学 一种基于非线性模型预测控制的智能车换道轨迹规划方法
CN110539752B (zh) * 2019-06-26 2020-12-18 江苏大学 一种智能汽车多预测范围模型预测轨迹跟踪控制方法及系统
CN110281912B (zh) * 2019-07-08 2020-10-16 江苏开放大学（江苏城市职业学院） 一种智能车辆横向纵向综合控制系统及控制方法
CN110349187B (zh) * 2019-07-18 2023-04-14 深圳大学 基于tsk模糊分类器的目标跟踪方法、装置及存储介质
CN110780091A (zh) * 2019-07-31 2020-02-11 中国第一汽车股份有限公司 一种车辆加速度的获取方法
CN110398969B (zh) * 2019-08-01 2022-09-27 北京主线科技有限公司 自动驾驶车辆自适应预测时域转向控制方法及装置
CN110320809B (zh) * 2019-08-19 2022-04-01 杭州电子科技大学 一种基于模型预测控制的agv轨迹修正方法
CN112537297B (zh) * 2019-09-20 2022-05-13 比亚迪股份有限公司 车道保持方法、系统及车辆
CN110843766B (zh) * 2019-10-31 2021-07-13 泰斗微电子科技有限公司 车辆姿态检测方法、装置、车载终端、车辆和介质
CN111123701B (zh) * 2019-11-27 2021-07-06 武汉理工大学 基于管道预测模型的自动驾驶路径跟踪抗干扰控制方法
CN110989625B (zh) * 2019-12-25 2020-11-27 湖南大学 一种车辆路径跟踪控制方法
CN113156934B (zh) * 2019-12-31 2022-02-25 上海司南卫星导航技术股份有限公司 一种车辆的自动驾驶系统及其方法、非临时性计算机可读存储介质
CN111258312B (zh) * 2020-01-20 2024-04-02 深圳市商汤科技有限公司 可移动模型及其控制方法、装置、系统、设备和存储介质
US11814073B2 (en) * 2020-03-18 2023-11-14 Baidu Usa Llc Learning based controller for autonomous driving
CN111679575B (zh) * 2020-05-14 2022-05-20 江苏大学 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法
CN113076641B (zh) * 2021-03-31 2022-09-20 同济大学 基于风险评估的智能车人机协同转向控制并行计算方法
CN113830074A (zh) * 2021-09-28 2021-12-24 中国科学技术大学先进技术研究院 基于极限工况的智能驾驶车辆纵横向控制方法和系统
CN114435399B (zh) * 2022-01-27 2023-09-12 上海工程技术大学 基于预测模型的自动驾驶汽车稳定性路径跟踪方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101186202A (zh) * 2006-11-22 2008-05-28 株式会社爱德克斯 用于车辆的转向角控制设备
CN207328574U (zh) * 2017-05-08 2018-05-08 江苏大学 一种基于主动安全的智能汽车轨迹跟踪控制系统

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101186202A (zh) * 2006-11-22 2008-05-28 株式会社爱德克斯 用于车辆的转向角控制设备
CN207328574U (zh) * 2017-05-08 2018-05-08 江苏大学 一种基于主动安全的智能汽车轨迹跟踪控制系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于GPS/INS和线控转向的农业机械自动驾驶系统;刘军;《农业工程学报》;20160108;正文第1节至第5节 *

Also Published As

Publication number Publication date
CN107161207A (zh) 2017-09-15

Similar Documents

Publication Publication Date Title
CN107161207B (zh) 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法
CN111845774B (zh) 一种基于横纵向协调的自动驾驶汽车动态轨迹规划及跟踪方法
CN109318905B (zh) 一种智能汽车路径跟踪混合控制方法
Ni et al. Envelope control for four-wheel independently actuated autonomous ground vehicle through AFS/DYC integrated control
Ni et al. Dynamics control of autonomous vehicle at driving limits and experiment on an autonomous formula racing car
CN112733270B (zh) 车辆行驶轨迹预测和轨迹偏离危险度评估的系统与方法
Cai et al. Implementation and development of a trajectory tracking control system for intelligent vehicle
Li et al. Comprehensive tire–road friction coefficient estimation based on signal fusion method under complex maneuvering operations
CN110827535B (zh) 非线性车辆队列协同自适应抗扰纵向控制方法
CN111258323A (zh) 一种智能车辆轨迹规划与跟踪的联合控制方法
Attia et al. Coupled longitudinal and lateral control strategy improving lateral stability for autonomous vehicle
CN207328574U (zh) 一种基于主动安全的智能汽车轨迹跟踪控制系统
CN114379583A (zh) 一种基于神经网络动力学模型的自动驾驶车辆轨迹跟踪系统及方法
Huang et al. Lateral stability control of four-wheel independent drive electric vehicles based on model predictive control
CN113581201A (zh) 一种基于势场模型的无人汽车避撞控制方法及系统
CN116552550A (zh) 基于参数不确定性和横摆稳定性的车辆轨迹跟踪控制系统
Li et al. Adaptive sliding mode control of lateral stability of four wheel hub electric vehicles
Kebbati et al. Coordinated PSO-PID based longitudinal control with LPV-MPC based lateral control for autonomous vehicles
CN116834754A (zh) 一种自动驾驶车辆自适应调速的横纵协同控制方法
Chen et al. MPC based path tracking control for autonomous vehicle with multi-constraints
Liu et al. Path tracking control for inverse vehicle handling dynamics
CN113602278B (zh) 四轮独立驱动电动汽车分布式模型预测路径跟踪控制方法
Chen et al. An overtaking obstacle algorithm for autonomous driving based on dynamic trajectory planning
CN114179818A (zh) 基于自适应预瞄时间和滑模控制的智能汽车横向控制方法
Kang et al. Skid steering based maneuvering of robotic vehicle with articulated suspension

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