CN110209177A - 基于模型预测和自抗扰的无人驾驶汽车控制系统及方法 - Google Patents

基于模型预测和自抗扰的无人驾驶汽车控制系统及方法 Download PDF

Info

Publication number
CN110209177A
CN110209177A CN201910592104.9A CN201910592104A CN110209177A CN 110209177 A CN110209177 A CN 110209177A CN 201910592104 A CN201910592104 A CN 201910592104A CN 110209177 A CN110209177 A CN 110209177A
Authority
CN
China
Prior art keywords
model
current
state
prediction
control amount
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
Application number
CN201910592104.9A
Other languages
English (en)
Other versions
CN110209177B (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.)
Tianjin University
Original Assignee
Tianjin 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 Tianjin University filed Critical Tianjin University
Priority to CN201910592104.9A priority Critical patent/CN110209177B/zh
Publication of CN110209177A publication Critical patent/CN110209177A/zh
Application granted granted Critical
Publication of CN110209177B publication Critical patent/CN110209177B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • 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
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • 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
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • 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
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Software Systems (AREA)
  • Medical Informatics (AREA)
  • Evolutionary Computation (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本公开提供了一种基于模型预测和自抗扰的无人驾驶汽车控制系统及方法，其控制方法包括：建立当前模型，根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；分别预测参考模型在预测时域内的输出，以及当前模型与参考模型间的输出误差；得到在预测时域内当前模型的输出；进行线性优化，得到最优控制序列；将状态误差模型转化为积分链的形式，得到扩张状态量；通过状态反馈得到自抗扰控制量；模型预测控制量与自抗扰控制量相加得到总控制量，对无人汽车模型进行横向控制。本公开将模型预测控制与自抗扰控制相结合，用扩张状态观测器跟踪作用于无人驾驶汽车的总扰动，并通过非线性反馈对扰动进行补偿，能够有效抑制各种扰动。

Description

基于模型预测和自抗扰的无人驾驶汽车控制系统及方法
技术领域
本公开涉及无人驾驶汽车领域，尤其涉及一种基于模型预测和自抗扰的无人驾驶汽车控制系统及方法。
背景技术
无人驾驶汽车对军事、运输、自动化工业、环境等方面有着十分重大的意义。近几年，人工智能快速崛起，无人驾驶汽车作为人工智能最重要的应用平台，获得了社会各界的广泛关注。
无人驾驶系统可以分为全局路径规划、环境感知、行为和轨迹规划以及轨迹追踪四个模块。其中轨迹追踪模块由横向控制和纵向控制两个子模块组成。横向控制子模块可以让无人驾驶汽车保持在期望轨迹上，而纵向控制则可以令无人驾驶汽车以规划的速度运行。该模块是无人驾驶系统的基础环节，精确的横向控制不仅可以保证无人驾驶汽车的安全性和可靠性，还可以为行为和轨迹规划模块制定更为复杂的运动策略提供依据。横向控制作为无人驾驶汽车的核心技术，得到了相关科研人员的高度重视。起初，学者们采用比例-积分-微分(PID)控制器完成无人驾驶汽车的横向控制任务，还有一些其它算法被用于无人驾驶汽车的横向控制，如自适应控制、鲁棒控制、神经网络控制、模糊控制等，但由于汽车本身物理结构、舒适度要求、道路边沿、其他交通参与者以及交通规则等因素会给无人驾驶汽车的运动带来各种各样的约束，所以这些控制方法并没有达到令人满意的控制效果。
发明内容
(一)要解决的技术问题
本公开提供了一种基于模型预测和自抗扰的无人驾驶汽车控制系统及方法，以至少部分解决以上所提出的技术问题。
(二)技术方案
根据本公开的一个方面，提供了一种基于模型预测和自抗扰的无人驾驶汽车控制方法，包括：
步骤1：建立当前模型，根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；
步骤2：分别预测参考模型在预测时域内的输出，以及当前模型与参考模型间的输出误差；得到在预测时域内当前模型的输出；进行线性优化，得到模型预测控制量；
步骤3：将状态误差模型转化为积分链的形式，得到扩张状态量；通过状态反馈得到自抗扰控制量；
步骤4：模型预测控制量与自抗扰控制量相加得到总控制量，对无人汽车模型进行横向控制。
在本公开的一些实施例中，所述步骤1包括：
步骤1.1：建立当前模型；
根据汽车的运动学特性将其运动学车辆模型简化为当前模型：
其中，(x，y)是汽车后轴中心的坐标，是汽车的航向角，v是汽车后轴中心的纵向速度，δ是汽车的前轮偏角，L是汽车的轴距；
式(1)所描述的当前模型表示为一般形式如下：
其中是当前模型的状态量，u＝δ是当前模型的控制量；
步骤1.2：根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；
假设ζt为当前模型当前的运行点，并且当前的控制量为ut-1，该控制量为上一时刻控制量，在当前运行时刻应用泰勒展开对当前模型进行线性化得到：
将式(1)和式(2)带代入到式(3)中得到无人驾驶汽车的状态误差模型：
其中假设了一个参考模型，该参考模型的当前状态为ζt，而控制量ut-1从始至终保持不变，vt是车辆当前的速度，表示当前模型和参考模型之间的状态误差，表示两个系统之间的输入偏差；
将该状态误差模型离散化之后得到：
其中是当前模型矩阵，是当前模型的输出，T是当前模型的控制周期。
在本公开的一些实施例中，所述步骤2包括：
步骤2.1：预测参考模型在预测时域内的输出，构造圆弧预测预测参考模型的输出；其中R是车辆的转弯半径，(x0，y0)是车辆运动的圆心，是车辆每个周期内转过的圆心角度数；
步骤2.2：预测当前模型和参考模型之间的输出误差：
令将离散后的状态误差模型转化为：
其中，I为适当维数的单位矩阵；
为了简化计算量，假设
其中，
在预测时域内当前模型和参考模型之间的输出误差表示为：
其中，
由寸公式(13)化简为：
步骤2.3：在预测时域内，当前模型的输出为：
步骤2.4：假设一条可行的参考轨迹Yref(t)已经在行为和轨迹规划层生成，构造线性优化问题：
分别满足下述条件：
其中，“||*||2”表示矩阵的二范数，Q、R、S分别是对追踪误差、控制增量和控制量的惩罚项系数矩阵，和是控制量的上下限，和是控制增量的上下限；
步骤2.5：求解公式(16)的优化问题，进行线性优化，得到最优控制序列：
其中上标“T”表示矩阵的转置，上标“*”表示最优量；
将的第一个分量作用在当前模型上，对应的模型预测控制量为：
在本公开的一些实施例中，所述步骤3包括：
步骤3.1：将状态误差模型转化为积分链的形式；
在考虑各种扰动并将其视为一个总扰动之后，将无人驾驶汽车的状态误差模型表示为：
其中，是一个非线性时变函数，代表系统总扰动，为系统的输出；
令公式(19)表示为：
令带扰动的当前模型表示为：
步骤3.2：扩张状态观测器表示为如下形式：
其中，β1、β2和β3是扩张状态观测器的增益，z1、z2和z3分别用来估计χ1、χ2和χ3的值；
总扰动的估计值为：
步骤3.3：使用扰动的观测值消除扰动；
将公式(23)代入公式(19)得到：
通过状态反馈得到自抗扰控制量为：
所述步骤4包括：
步骤4.1：模型预测控制量与自抗扰控制量相加得到总控制量
u(t)＝uLMPC(t)+uADRC(t) (26)
步骤4.2：利用步骤4.1得到的总控制量对无人汽车模型进行横向控制。
在本公开的一些实施例中，所述步骤2.1中，
如果δt-1＝0，车辆的轨迹为一个线段，参考模型的状态表示为：
其中下标“r”表示参考模型的变量，“t+k|t”表示在t时刻预测的t+k时刻的变量，Np为控制系统的预测时域。
在本公开的一些实施例中，所述步骤2.1中，
如果δt-1≠0，车辆的轨迹为一段圆弧且圆弧的半径为：
车辆运动的圆心和每个周期内走过的圆心角为：
得到参考模型在预测时域内的状态为：
基于公式(6)-公式(9)，得到参考模型在预测时域内的输出为：
其中Nc为控制系统的控制时域。
在本公开的一些实施例中，扩张状态观测器的增益β1、β2和β3间的取值分别为：
β1＝3ω0
β2＝3ω0 2
β3＝ω0 3
其中，ω0为扩张状态观测器带宽。
在本公开的一些实施例中，扩张状态观测器中非线性函数fi(e1)(i＝1，2)为满足e1fi(e1)≥0的任意函数。
根据本公开的一个方面，提供了一种基于模型预测和自抗扰的无人驾驶汽车控制系统，包括：
线性模型预测控制器，根据参考输入、参考模型状态和当前模型状态进行实时优化并给出模型预测控制量；
自抗扰控制器，根据总控制量和车辆状态与当前模型状态的误差输出扩张状态量，将扩张状态量通过状态反馈得到自抗扰控制量；
无人汽车模型，接收线性模型预测控制器输出的模型预测控制量与自抗扰控制器输出的自抗扰控制量相加得到的总控制量，对无人汽车模型进行横向控制。
在本公开的一些实施例中，
所述线性模型预测控制器包括：
当前模型模块，建立当前模型并得到当前模型状态；
参考模型模块，得到参考模型状态；
参考轨迹模块，建立参考轨迹进行参考输入；
优化算法模块，根据当前模型模块的当前模型状态、参考模型模块的参考模型状态和参考轨迹模块的参考输入进行实时优化，输出模型预测控制量；
所述自抗扰控制器包括：
扩张状态观测模块，根据总控制量和车辆状态与当前模型状态的误差输出扩张状态量；
状态反馈模块，对所述扩张状态观测模块输入的扩张状态量进行状态反馈，得到自抗扰控制量。
(三)有益效果
从上述技术方案可以看出，本公开基于模型预测和自抗扰的无人驾驶汽车控制系统及方法至少具有以下有益效果其中之一或其中一部分：
(1)本公开将模型预测控制与自抗扰控制相结合，用扩张状态观测器跟踪作用于无人驾驶汽车的总扰动，并通过非线性反馈对扰动进行补偿，能够有效抑制各种扰动。
(2)本公开提供的是基于车辆的运动学模型构建的控制器，能够有效提升计算速度。
附图说明
图1为本公开实施例基于模型预测和自抗扰的无人驾驶汽车控制方法的示意图。
图2为本公开实施例基于模型预测和自抗扰的无人驾驶汽车控制系统的示意图。
图3为汽车的单轨模型示意图。
图4为圆弧预测示意图。
图5为本公开实施例在10m/s时的仿真结果。
图6为本公开实施例在20m/s时的仿真结果。
具体实施方式
在本公开的一个示例性实施例中，提供了一种基于模型预测和自抗扰的无人驾驶汽车控制系统及方法。图1为本公开实施例基于模型预测和自抗扰的无人驾驶汽车控制器设计方法的示意图。如图1所示，基于模型预测和自抗扰的无人驾驶汽车控制方法，包括如下步骤：
步骤1：建立当前模型，根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；
步骤2：分别预测参考模型在预测时域内的输出，以及当前模型与参考模型间的输出误差；得到在预测时域内当前模型的输出；进行线性优化，得到模型预测控制量；
步骤3：将状态误差模型转化为积分链的形式，得到扩张状态量；通过状态反馈得到自抗扰控制量；
步骤4：模型预测控制量与自抗扰控制量相加得到总控制量，对无人汽车模型进行横向控制。
以下分别对各个步骤进行详细说明。
步骤1：建立当前模型，根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；包括：
步骤1.1：建立当前模型。如图3所示是汽车的单轨模型，根据汽车的运动学特性可以将运动学车辆模型简化为当前模型：
其中，(x，y)是汽车后轴中心的坐标，是汽车的航向角，v是汽车后轴中心的纵向速度，δ是汽车的前轮偏角，L是汽车的轴距。
式(1)所描述的当前模型可以表示为一般形式如下：
其中是当前模型的状态量，u＝δ是当前模型的控制量。
步骤1.2：根据当前模型和参考模型得到无人驾驶汽车的状态误差模型。
假设ζt为当前模型当前的运行点，并且当前的控制量为ut-1，该控制量是上一时刻得到的控制量。在当前运行时刻应用泰勒展开对当前模型进行线性化，可以得到：
将式(1)和式(2)带代入到式(3)中可以得到无人驾驶汽车的状态误差模型：
其中假设了一个参考模型，该参考模型的当前状态为ζt，而控制量ut-1从始至终保持不变，vt是车辆当前的速度，表示当前模型和参考模型之间的状态误差，表示当前模型和当前模型之间的输入偏差。
将该状态误差模型离散化之后可以得到：
其中是当前模型矩阵，是当前模型的输出，T是当前模型的控制周期。
步骤2：分别预测参考模型在预测时域内的输出，以及当前模型与参考模型间的输出误差；得到在预测时域内当前模型的输出；进行线性优化，得到模型预测控制量。具体包括下述：
步骤2.1：预测参考模型在预测时域内的输出。使用如图4所示的圆弧预测来预测参考系统的输出，其中R是车辆的转弯半径，(x0，y0)是车辆运动的圆心，是车辆每个周期内转过的圆心角度数。预测过程可以分为两种情况：
情况1：如果δt-1＝0，那么车辆的轨迹可以认为是一个线段，并且参考模型的状态可以表示为：
其中下标“r”表示参考模型的变量，“t+k|t”表示在t时刻预测的t+k时刻的变量，Np为控制器的预测时域。
情况2：如果δt-1≠0车辆的轨迹可以认为是一段圆弧，而圆弧的半径为：
车辆运动的圆心和每个周期内走过的圆心角为：
进而得到参考模型的在预测时域内的状态为：
基于公式(6)-公式(9)，可以得到参考模型在预测时域内的输出为：
其中Nc为控制器的控制时域。
步骤2.2：预测当前模型和参考模型之间的输出误差：
令公式(5)可以转化为：
其中，I为待定维数的单位矩阵。
为了简化计算量，假设
其中，
在预测时域内当前模型和参考模型之间的输出误差可以表示为：
其中，
因为公式(13)可以化简为：
步骤2.3：在预测时域内，当前模型的输出为：
步骤2.4：假设一条可行的参考轨迹Yref(t)已经在行为和轨迹规划层生成，于是可以构造以下线性优化问题：
分别满足下述条件：
其中，“||*||2”表示矩阵的二范数，Q、R、S分别是对追踪误差、控制增量和控制量的惩罚项系数矩阵，和是控制量的上下限，和是控制增量的上下限。
步骤2.5：求解公式(16)的优化问题，进行线性优化，得到最优控制序列：
其中上标“T”表示矩阵的转置，上标“*”表示最优量。
将的第一个分量作用在当前模型上，对应的控制量为：
步骤3：将状态误差模型转化为积分链的形式，得到扩张状态量；通过状态反馈得到自抗扰控制量。
步骤3.1：将状态误差模型转化为积分链的形式。
在考虑各种扰动并将其视为一个总扰动之后，公式(4)可以表示为以下形式：
其中，是一个非线性时变函数，代表系统总扰动，为系统的输出。
令公式(19)可以表示为：
然后，令带扰动的系统可以表示为以下形式：
步骤3.2：设计扩张状态观测器。
扩张状态观测器可以表示为如下形式：
其中，β1、β2和β3是扩张状态观测器的增益，z1、z2和z3分别用来估计χ1、χ2和χ3的值。
总扰动的估计值为：
步骤3.3：使用扰动的观测值来消除扰动。
将公式(23)代入公式(19)可以得到：
通过状态反馈得到自抗扰控制量为：
所述步骤4包括：模型预测控制量与自抗扰控制量相加得到总控制量，对无人汽车模型进行横向控制。
步骤4.1：模型预测控制量与自抗扰控制量相加得到总控制量
u(t)＝uLMPC(t)+uADRC(t) (26)
步骤4.2：利用步骤4.1得到的总控制量对无人汽车模型进行横向控制。
在本公开的一个示例性实施例中，提供了一种基于模型预测和自抗扰的无人驾驶汽车控制系统。本公开实施例基于模型预测和自抗扰的无人驾驶汽车控制系统的示意图。如图2所示，基于模型预测和自抗扰的无人驾驶汽车控制系统，包括：
线性模型预测控制器，根据参考输入、参考模型状态和当前模型状态进行实时优化并给出模型预测控制量。其中，具体包括：
当前模型模块，建立当前模型并得到当前模型状态。
参考模型模块，得到参考模型状态。
参考轨迹模块，建立参考轨迹进行参考输入。
优化算法模块，根据当前模型模块的当前模型状态、参考模型模块的参考模型状态和参考轨迹模块的参考输入进行实时优化，输出模型预测控制量。
自抗扰控制器，根据总控制量和车辆状态与当前模型状态的误差输出扩张状态量，将扩张状态量通过状态反馈得到自抗扰控制量。其中具体包括：
扩张状态观测模块，根据总控制量和车辆状态与当前模型状态的误差输出扩张状态量。
状态反馈模块，对所述扩张状态观测模块输入的扩张状态量进行状态反馈，得到自抗扰控制量。
无人汽车模型，接收线性模型预测控制器输出的模型预测控制量与自抗扰控制器输出的自抗扰控制量相加得到的总控制量，对无人汽车模型进行横向控制。
至此，本公开实施例介绍完毕。
以下给出车速分别10m/s和20m/s时的仿真结果。基于动力学模型的MPC、基于运动学模型的MPC以及MPC与ADRC相结合的横向控制系统分别命名为“控制器A”、“控制器B”和“控制器C”。
图5给出了车速为10m/s时的仿真结果从车辆的轨迹和追踪误差可以看出控制器A和控制器C的控制效果远好于控制器B，而控制器C的控制效果略好于控制器A。扰动观测值的变化规律与追踪误差的变化规律类似。从图6给出的车速为20m/s时的仿真结果中可以发现同样的情况，这说明ESO可以很好地估计总扰动的大小，并且自抗扰控制器的加入使横向控制器可以有效地抑制扰动，从而达到更好的控制效果。此外，从三个控制器的计算时间对比可以看出，控制器B和控制器C的计算时间远小于控制器A的计算时间，说明本发明设计的横向控制器可以在保证基于运动学模型的MPC的快速性的前提下，使其达到与基于动力学模型的MPC相接近的控制效果。
至此，已经结合附图对本公开实施例进行了详细描述。需要说明的是，在附图或说明书正文中，未绘示或描述的实现方式，均为所属技术领域中普通技术人员所知的形式，并未进行详细说明。此外，上述对各元件和方法的定义并不仅限于实施例中提到的各种具体结构、形状或方式，本领域普通技术人员可对其进行简单地更改或替换。
依据以上描述，本领域技术人员应当对本公开基于模型预测和自抗扰的无人驾驶汽车控制器设计方法有了清楚的认识。
综上所述，本公开提供一种基于模型预测和自抗扰的无人驾驶汽车控制器设计方法，将模型预测控制与自抗扰控制相结合，用扩张状态观测器跟踪作用于无人驾驶汽车的总扰动，并通过非线性反馈对扰动进行补偿，能够有效抑制各种扰动。
再者，单词“包含”不排除存在未列在权利要求中的元件或步骤。位于元件之前的单词“一”或“一个”不排除存在多个这样的元件。
说明书与权利要求中所使用的序数例如“第一”、“第二”、“第三”等的用词，以修饰相应的元件，其本身并不意味着该元件有任何的序数，也不代表某一元件与另一元件的顺序、或是制造方法上的顺序，该些序数的使用仅用来使具有某命名的一元件得以和另一具有相同命名的元件能做出清楚区分。
此外，除非特别描述或必须依序发生的步骤，上述步骤的顺序并无限制于以上所列，且可根据所需设计而变化或重新安排。并且上述实施例可基于设计及可靠度的考虑，彼此混合搭配使用或与其他实施例混合搭配使用，即不同实施例中的技术特征可以自由组合形成更多的实施例。
在此提供的算法和显示不与任何特定计算机、虚拟系统或者其它设备固有相关。各种通用系统也可以与基于在此的启示一起使用。根据上面的描述，构造这类系统所要求的结构是显而易见的。此外，本公开也不针对任何特定编程语言。应当明白，可以利用各种编程语言实现在此描述的本公开的内容，并且上面对特定语言所做的描述是为了披露本公开的最佳实施方式。
类似地，应当理解，为了精简本公开并帮助理解各个公开方面中的一个或多个，在上面对本公开的示例性实施例的描述中，本公开的各个特征有时被一起分组到单个实施例、图、或者对其的描述中。然而，并不应将该公开的方法解释成反映如下意图：即所要求保护的本公开要求比在每个权利要求中所明确记载的特征更多的特征。更确切地说，如下面的权利要求书所反映的那样，公开方面在于少于前面公开的单个实施例的所有特征。因此，遵循具体实施方式的权利要求书由此明确地并入该具体实施方式，其中每个权利要求本身都作为本公开的单独实施例。
以上所述的具体实施例，对本公开的目的、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本公开的具体实施例而已，并不用于限制本公开，凡在本公开的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本公开的保护范围之内。

Claims (10)

1.一种基于模型预测和自抗扰的无人驾驶汽车控制方法，包括：
步骤1：建立当前模型，根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；
步骤2：分别预测参考模型在预测时域内的输出，以及当前模型与参考模型间的输出误差；得到在预测时域内当前模型的输出；进行线性优化，得到模型预测控制量；
步骤3：将状态误差模型转化为积分链的形式，得到扩张状态量；通过状态反馈得到自抗扰控制量；
步骤4：模型预测控制量与自抗扰控制量相加得到总控制量，对无人汽车模型进行横向控制。
2.根据权利要求1所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，所述步骤1包括：
步骤1.1：建立当前模型；
根据汽车的运动学特性将其运动学车辆模型简化为当前模型：
其中，(x，y)是汽车后轴中心的坐标，是汽车的航向角，v是汽车后轴中心的纵向速度，δ是汽车的前轮偏角，L是汽车的轴距；
式(1)所描述的当前模型表示为一般形式如下：
其中是当前模型的状态量，u＝δ是当前模型的控制量；
步骤1.2：根据当前模型和参考模型得到无人驾驶汽车的状态误差模型；
假设ζt为当前模型当前的运行点，并且当前的控制量为ut-1，该控制量为上一时刻控制量，在当前运行时刻应用泰勒展开对当前模型进行线性化得到：
将式(1)和式(2)带代入到式(3)中得到无人驾驶汽车的状态误差模型：
其中假设了一个参考模型，该参考模型的当前状态为ζt，而控制量ut-1从始至终保持不变，vt是车辆当前的速度，表示当前模型和参考模型之间的状态误差，表示两个系统之间的输入偏差；
将该状态误差模型离散化之后得到：
其中是当前模型矩阵，是当前模型的输出，T是当前模型的控制周期。
3.根据权利要求1所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，所述步骤2包括：
步骤2.1：预测参考模型在预测时域内的输出，构造圆弧预测预测参考模型的输出；其中R是车辆的转弯半径，(x0，y0)是车辆运动的圆心，是车辆每个周期内转过的圆心角度数；
步骤2.2：预测当前模型和参考模型之间的输出误差：
令将离散后的状态误差模型转化为：
其中，I为适当维数的单位矩阵；
为了简化计算量，假设
其中，
在预测时域内当前模型和参考模型之间的输出误差表示为：
其中，
由于公式(13)化简为：
步骤2.3：在预测时域内，当前模型的输出为：
步骤2.4：假设一条可行的参考轨迹Yref(t)已经在行为和轨迹规划层生成，构造线性优化问题：
分别满足下述条件：
其中，“||*||2”表示矩阵的二范数，Q、R、S分别是对追踪误差、控制增量和控制量的惩罚项系数矩阵，和是控制量的上下限，和是控制增量的上下限；
步骤2.5：求解公式(16)的优化问题，进行线性优化，得到最优控制序列：
其中上标“T”表示矩阵的转置，上标“*”表示最优量；
将的第一个分量作用在当前模型上，对应的模型预测控制量为：
4.根据权利要求1所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，
所述步骤3包括：
步骤3.1：将状态误差模型转化为积分链的形式；
在考虑各种扰动并将其视为一个总扰动之后，将无人驾驶汽车的状态误差模型表示为：
其中，是一个非线性时变函数，代表系统总扰动，为系统的输出；
令公式(19)表示为：
令带扰动的当前模型表示为：
步骤3.2：扩张状态观测器表示为如下形式：
其中，β1、β2和β3是扩张状态观测器的增益，z1、z2和z3分别用来估计χ1、χ2和χ3的值；
总扰动的估计值为：
步骤3.3：使用扰动的观测值消除扰动；
将公式(23)代入公式(19)得到：
通过状态反馈得到自抗扰控制量为：
所述步骤4包括：
步骤4.1：模型预测控制量与自抗扰控制量相加得到总控制量
u(t)＝uLMPC(t)+uADRC(t) (26)
步骤4.2：利用步骤4.1得到的总控制量对无人汽车模型进行横向控制。
5.根据权利要求3所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，所述步骤2.1中，
如果δt-1＝0，车辆的轨迹为一个线段，参考模型的状态表示为：
其中下标“r”表示参考模型的变量，“t+k|t”表示在t时刻预测的t+k时刻的变量，Np为控制系统的预测时域。
6.根据权利要求5所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，所述步骤2.1中，
如果δt-1≠0，车辆的轨迹为一段圆弧且圆弧的半径为：
车辆运动的圆心和每个周期内走过的圆心角为：
得到参考模型在预测时域内的状态为：
基于公式(6)-公式(9)，得到参考模型在预测时域内的输出为：
其中Nc为控制系统的控制时域。
7.根据权利要求4所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，扩张状态观测器的增益β1、β2和β3间的取值分别为：
β1＝3ω0
β2＝3ω0 2
β3＝ω0 3
其中，ω0为扩张状态观测器带宽。
8.根据权利要求4所述的基于模型预测和自抗扰的无人驾驶汽车控制方法，其中，扩张状态观测器中非线性函数fi(e1)(i＝1，2)为满足e1fi(e1)≥0的任意函数。
9.一种基于模型预测和自抗扰的无人驾驶汽车控制系统，包括：
线性模型预测控制器，根据参考输入、参考模型状态和当前模型状态进行实时优化并给出模型预测控制量；
自抗扰控制器，根据总控制量和车辆状态与当前模型状态的误差输出扩张状态量，将扩张状态量通过状态反馈得到自抗扰控制量；
无人汽车模型，接收线性模型预测控制器输出的模型预测控制量与自抗扰控制器输出的自抗扰控制量相加得到的总控制量，对无人汽车模型进行横向控制。
10.根据权利要求9所述的基于模型预测和自抗扰的无人驾驶汽车控制系统，其中，
所述线性模型预测控制器包括：
当前模型模块，建立当前模型并得到当前模型状态；
参考模型模块，得到参考模型状态；
参考轨迹模块，建立参考轨迹进行参考输入；
优化算法模块，根据当前模型模块的当前模型状态、参考模型模块的参考模型状态和参考轨迹模块的参考输入进行实时优化，输出模型预测控制量；
所述自抗扰控制器包括：
扩张状态观测模块，根据总控制量和车辆状态与当前模型状态的误差输出扩张状态量；
状态反馈模块，对所述扩张状态观测模块输入的扩张状态量进行状态反馈，得到自抗扰控制量。
CN201910592104.9A 2019-07-02 2019-07-02 基于模型预测和自抗扰的无人驾驶汽车控制方法 Active CN110209177B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910592104.9A CN110209177B (zh) 2019-07-02 2019-07-02 基于模型预测和自抗扰的无人驾驶汽车控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910592104.9A CN110209177B (zh) 2019-07-02 2019-07-02 基于模型预测和自抗扰的无人驾驶汽车控制方法

Publications (2)

Publication Number Publication Date
CN110209177A true CN110209177A (zh) 2019-09-06
CN110209177B CN110209177B (zh) 2022-04-15

Family

ID=67795891

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910592104.9A Active CN110209177B (zh) 2019-07-02 2019-07-02 基于模型预测和自抗扰的无人驾驶汽车控制方法

Country Status (1)

Country Link
CN (1) CN110209177B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111025907A (zh) * 2019-12-20 2020-04-17 苏州智加科技有限公司 一种自动驾驶卡车的横向控制方法、系统及存储介质
CN111258218A (zh) * 2020-01-17 2020-06-09 成都信息工程大学 基于最大相关熵准则的智能车辆路径跟踪方法
CN111267867A (zh) * 2020-02-20 2020-06-12 北京理工大学 构建无人驾驶车辆运动特性模型的方法和装置
WO2021052383A1 (en) * 2019-09-17 2021-03-25 Huawei Technologies Co., Ltd. Methods and systems for observation prediction in autonomous vehicles
CN113341943A (zh) * 2020-03-03 2021-09-03 天津大学 基于总扰动即时观测与迭代学习的重复作业式无人驾驶车辆轨迹跟踪控制算法
CN113734182A (zh) * 2020-05-29 2021-12-03 比亚迪股份有限公司 一种车辆自适应控制方法及其装置
CN114489010A (zh) * 2022-01-25 2022-05-13 佛山智能装备技术研究院 一种adrc扩张观测器状态观测误差实时预测方法及系统
CN115416654A (zh) * 2022-11-03 2022-12-02 北京清研宏达信息科技有限公司 一种基于自抗扰的人机共驾车速控制方法及系统

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103970137A (zh) * 2014-05-08 2014-08-06 北京理工大学 基于自抗扰的alv横向位移跟踪系统控制方法
US20170291638A1 (en) * 2016-04-07 2017-10-12 GM Global Technology Operations LLC Autonomous vehicle lateral control for path tracking and stability
CN107831761A (zh) * 2017-10-16 2018-03-23 中国科学院电工研究所 一种智能车的路径跟踪控制方法
CN109597308A (zh) * 2019-01-15 2019-04-09 天津大学 基于动力学模型的无人驾驶汽车模型预测控制器设计方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103970137A (zh) * 2014-05-08 2014-08-06 北京理工大学 基于自抗扰的alv横向位移跟踪系统控制方法
US20170291638A1 (en) * 2016-04-07 2017-10-12 GM Global Technology Operations LLC Autonomous vehicle lateral control for path tracking and stability
CN107831761A (zh) * 2017-10-16 2018-03-23 中国科学院电工研究所 一种智能车的路径跟踪控制方法
CN109597308A (zh) * 2019-01-15 2019-04-09 天津大学 基于动力学模型的无人驾驶汽车模型预测控制器设计方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
李宗俐: "基于干扰观测器的模型预测控制器设计与实现", 《中国优秀硕士学位论文全文数据库信息科技辑》 *

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021052383A1 (en) * 2019-09-17 2021-03-25 Huawei Technologies Co., Ltd. Methods and systems for observation prediction in autonomous vehicles
CN111025907A (zh) * 2019-12-20 2020-04-17 苏州智加科技有限公司 一种自动驾驶卡车的横向控制方法、系统及存储介质
CN111258218A (zh) * 2020-01-17 2020-06-09 成都信息工程大学 基于最大相关熵准则的智能车辆路径跟踪方法
CN111267867A (zh) * 2020-02-20 2020-06-12 北京理工大学 构建无人驾驶车辆运动特性模型的方法和装置
CN111267867B (zh) * 2020-02-20 2021-08-10 北京理工大学 构建无人驾驶车辆运动特性模型的方法和装置
CN113341943A (zh) * 2020-03-03 2021-09-03 天津大学 基于总扰动即时观测与迭代学习的重复作业式无人驾驶车辆轨迹跟踪控制算法
CN113341943B (zh) * 2020-03-03 2022-10-11 天津大学 基于总扰动即时观测与迭代学习的重复作业式无人驾驶车辆轨迹跟踪控制算法
CN113734182A (zh) * 2020-05-29 2021-12-03 比亚迪股份有限公司 一种车辆自适应控制方法及其装置
CN113734182B (zh) * 2020-05-29 2023-11-14 比亚迪股份有限公司 一种车辆自适应控制方法及其装置
CN114489010A (zh) * 2022-01-25 2022-05-13 佛山智能装备技术研究院 一种adrc扩张观测器状态观测误差实时预测方法及系统
CN115416654A (zh) * 2022-11-03 2022-12-02 北京清研宏达信息科技有限公司 一种基于自抗扰的人机共驾车速控制方法及系统

Also Published As

Publication number Publication date
CN110209177B (zh) 2022-04-15

Similar Documents

Publication Publication Date Title
CN110209177A (zh) 基于模型预测和自抗扰的无人驾驶汽车控制系统及方法
Kurnaz et al. Adaptive neuro-fuzzy inference system based autonomous flight control of unmanned air vehicles
CN107943071B (zh) 无人车的编队保持控制方法及系统
Chen et al. Cooperative multi-vessel systems in urban waterway networks
US20200278686A1 (en) Iterative Feedback Motion Planning
Ailon et al. Control strategies for driving a group of nonholonomic kinematic mobile robots in formation along a time-parameterized path
Wang et al. Integrated path planning and trajectory tracking control for quadrotor UAVs with obstacle avoidance in the presence of environmental and systematic uncertainties: Theory and experiment
CN112327872B (zh) 面向溢油围捕的双无人艇协同轨迹跟踪方法
Gao et al. Robust fuzzy adaptive output feedback optimal tracking control for dynamic positioning of marine vessels with unknown disturbances and uncertain dynamics
Bazoula et al. Formation control of multi-robots via fuzzy logic technique
Gao et al. Cola-hrl: Continuous-lattice hierarchical reinforcement learning for autonomous driving
Yu et al. Trajectory Planning and Tracking for Carrier Aircraft‐Tractor System Based on Autonomous and Cooperative Movement
Xi et al. MPC based motion control of car-like vehicle swarms
Németh et al. Design of learning-based control with guarantees for autonomous vehicles in intersections
Dai et al. Path planning for multiple unmanned aerial vehicles by parameterized cornu-spirals
Breivik et al. Guided formation control for wheeled mobile robots
Duan et al. Implementing trajectory tracking control algorithm for autonomous vehicles
CN113821028A (zh) 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法
Lindqvist et al. Collision avoidance for multiple micro aerial vehicles using fast centralized nonlinear model predictive control
Viel et al. Platooning control for sailboats using a tack strategy
Mobus et al. Constrained optimal control for lateral vehicle guidance
Bassolillo et al. A recurrent planning strategy for uav optimum path identification in a dynamic environment based on bit-coded flight manoeuvres
Wang Control system design for autonomous vehicle path following and collision avoidance
Tol et al. A bi-level local and global model predictive control architecture for air traffic management
Aksjonov et al. A safety-critical decision making and control framework combining machine learning and rule-based algorithms

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