CN113147763A - 面向协同自适应巡航控制预期功能安全的容错控制方法 - Google Patents

面向协同自适应巡航控制预期功能安全的容错控制方法 Download PDF

Info

Publication number
CN113147763A
CN113147763A CN202110496863.2A CN202110496863A CN113147763A CN 113147763 A CN113147763 A CN 113147763A CN 202110496863 A CN202110496863 A CN 202110496863A CN 113147763 A CN113147763 A CN 113147763A
Authority
CN
China
Prior art keywords
control
adaptive cruise
performance
augmented
cruise control
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
CN202110496863.2A
Other languages
English (en)
Other versions
CN113147763B (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.)
Tsinghua University
Original Assignee
Tsinghua 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 Tsinghua University filed Critical Tsinghua University
Priority to CN202110496863.2A priority Critical patent/CN113147763B/zh
Publication of CN113147763A publication Critical patent/CN113147763A/zh
Application granted granted Critical
Publication of CN113147763B publication Critical patent/CN113147763B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/14—Adaptive cruise control
    • B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • 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
    • B60W2050/0031—Mathematical model of the vehicle
    • B60W2050/0034—Multiple-track, 2D vehicle model, e.g. four-wheel model
    • B60W2420/408—
    • 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
    • B60W2754/00—Output or target parameters relating to objects
    • B60W2754/10—Spatial relation or speed relative to objects
    • B60W2754/30—Longitudinal distance
    • 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
    • B60W2754/00—Output or target parameters relating to objects
    • B60W2754/10—Spatial relation or speed relative to objects
    • B60W2754/50—Relative longitudinal speed
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/10—Internal combustion engine [ICE] based vehicles
    • Y02T10/40—Engine management systems

Abstract

本发明公开了一种面向协同自适应巡航控制预期功能安全的容错控制方法及装置，建立以雷达传感器和车载惯性测量单元为反馈输入、V2X协同信息为前馈输入，相对距离误差、相对速度和自车加速度为输出的，包含雷达传感器和控制执行系统性能缺陷的增广状态空间模型；在此模型的基础上构造传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，实时估计出协同式自适应巡航控制系统增广状态和性能缺陷；据此综合计算在线主动容错控制率，并输入车辆底盘控制系统，生成加速踏板开度和制动踏板开度。能够增强协同式自适应巡航控制功能的态势认知和场景适应能力，使之在多性能缺陷的状况下仍然能够安全稳定地运行，保障该功能的预期功能安全。

Description

面向协同自适应巡航控制预期功能安全的容错控制方法
技术领域
本发明涉及智能网联汽车技术领域，特别涉及一种面向协同自适应巡航控制预期功能安全的容错控制方法及装置。
背景技术
智能化和信息化技术的发展促进了智能网联汽车的创新。近年来，许多智能网联汽车技术被提出，其中，协同式自适应巡航控制通过扩展V2V通信实现多车互联，达到缩短跟车时距、提高道路通行效率、减少能量损耗的目的，是智能网联汽车技术中最接近最终形态的一种。
安全是智能网联汽车运行的基础，因此，由于预期功能及其实施过程造成的不合理风险必须被降低到可接受的水平。智能网联汽车依赖先进感知、决策和控制执行软、硬件，实现在复杂动态环境中的运行，对软硬件性能缺陷十分敏感，上述特点对智能网联汽车的安全提出了严峻的挑战，即预期功能安全问题。因此，保障协同式自适应巡航控制预期功能安全对此项技术的推广应用具有十分重要的现实意义。
发明内容
本发明旨在至少在一定程度上解决相关技术中的技术问题之一。
为此，本发明的一个目的在于提出一种面向协同自适应巡航控制预期功能安全的容错控制方法，该方法解决了协同式自适应巡航控制在实际运行过程中，由于感知传感器和线控执行设备由于自身设计缺陷，造成的整车碰撞等不合理风险的问题。
本发明的另一个目的在于提出一种面向协同自适应巡航控制预期功能安全的容错控制装置。
为达到上述目的，本发明一方面实施例提出了一种面向协同自适应巡航控制预期功能安全的容错控制方法，包括以下步骤：
建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型，以雷达传感器性能缺陷作为增广状态，构造增广的协同式自适应巡航控制系统数学模型；
根据所述增广的协同式自适应巡航控制系统数学模型，构造包含控制执行性能缺陷模型的传递参数，建立包含控制执行性能缺陷估计的传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，构造触发条件检测方法；
根据所述传递参数估计器、所述增广状态估计器和所述控制执行性能缺陷估计器输出的传递参数估计值、增广状态估计值、控制执行性能缺陷估计值、以及所述触发条件检测方法输出的触发条件检测结果，计算面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率；
将所述多性能缺陷主动容错控制率作为车辆驱动、制动控制执行的控制输入，生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度。
为达到上述目的，本发明另一方面实施例提出了一种面向协同自适应巡航控制预期功能安全的容错控制装置，包括：
第一构造模块，用于建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型，以雷达传感器性能缺陷作为增广状态，构造增广的协同式自适应巡航控制系统数学模型；
第二构造模块，用于根据所述增广的协同式自适应巡航控制系统数学模型，构造包含控制执行性能缺陷模型的传递参数，建立包含控制执行性能缺陷估计的传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，构造触发条件检测方法；
计算模块，用于根据所述传递参数估计器、所述增广状态估计器和所述控制执行性能缺陷估计器输出的传递参数估计值、增广状态估计值、控制执行性能缺陷估计值、以及所述触发条件检测方法输出的触发条件检测结果，计算面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率；
控制模块，用于将所述多性能缺陷主动容错控制率作为车辆驱动、制动控制执行的控制输入，生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度。
本发明实施例的面向协同自适应巡航控制预期功能安全的容错控制方法及装置，应用于自适应巡航控制的控制系统中，工作时，建立的传递参数估计器、增广状态估计器和执行系统性能缺陷估计器分别给出线控执行设备性能缺陷、自车与前车的相对距离误差、自车与前车的相对速度、自车加速度、感知设备的性能缺陷实时数值；构造的触发条件检测方法给出触发条件检测结果。上述估计值和触发条件检测值都将传入构造的面向协同式自适应巡航控制预期功能安全的主动容错控制率中，对比现有普通的控制方法，该控制率将生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度，保障系统的预期功能安全。解决了协同式自适应巡航控制在实际运行过程中的感知和线控执行设备功能不足，造成整车碰撞等不合理风险的问题，保障该功能的预期功能安全。
本发明附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
附图说明
本发明上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解，其中：
图1为根据本发明一个实施例的面向协同自适应巡航控制预期功能安全的容错控制方法流程图；
图2为根据本发明一个实施例的面向协同自适应巡航控制预期功能安全的容错控制方法流程框图；
图3为根据本发明一个实施例控制下的车间相对距离误差对比图；
图4为根据本发明一个实施例控制下的车间相对速度误差对比图；
图5为根据本发明一个实施例控制下的自车加速度对比图；
图6为根据本发明一个实施例的面向协同自适应巡航控制预期功能安全的容错控制装置结构示意图。
具体实施方式
下面详细描述本发明的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，旨在用于解释本发明，而不能理解为对本发明的限制。
下面参照附图描述根据本发明实施例提出的面向协同自适应巡航控制预期功能安全的容错控制方法及装置。
首先将参照附图描述根据本发明实施例提出的面向协同自适应巡航控制预期功能安全的容错控制方法。
图1为根据本发明一个实施例的面向协同自适应巡航控制预期功能安全的容错控制方法流程图。
如图1所示，该面向协同自适应巡航控制预期功能安全的容错控制方法包括以下步骤：
步骤S1，建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型，以雷达传感器性能缺陷作为增广状态，构造增广的协同式自适应巡航控制系统数学模型。
可选地，建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型为：
Figure BDA0003054771160000041
yi(t)＝Cixi(t)+Ps,ipi(t)
其中，
Figure BDA0003054771160000042
u＝[ai ai-1]T
xi＝[εi Δvi ai]T为系统状态向量，εi为相对距离误差，Δvi为相对速度，ai为自车加速度，ai-1为前车加速度，Bi为输入矩阵，u为控制输入，Ai为系统矩阵，h为车头时距，ζi为发动机时间常数，Bpi为执行器性能缺陷矩阵，fpi为执行器性能缺陷向量，Ci为输出矩阵，Ps,i为雷达传感器性能缺陷参数矩阵，pi为雷达传感器性能缺陷向量。
可选地，增广状态为
Figure BDA0003054771160000043
其中pi＝[prdi prvi]T，增广的协同式自适应巡航控制系统数学模型表达式为：
Figure BDA0003054771160000044
Figure BDA0003054771160000045
定义
Figure BDA0003054771160000046
C1i＝[Ci Ps,i]，简化的增广的协同式自适应巡航控制系统数学模型为：
Figure BDA0003054771160000047
Figure BDA0003054771160000048
其中，O为维度适当的零向量，I为维度适当的单位向量，prdi、prvi分别为雷达传感器由性能缺陷造成的对两车相对距离、相对速度测量的测量偏差数值。
可以理解的是，本步骤建立的包含雷达传感器和驱动、制动执行系统性能缺陷的协同式自适应巡航控制系统数学模型是后续步骤开展触发条件检测、性能缺陷估计与主动容错控制的基础。
步骤S2，根据增广的协同式自适应巡航控制系统数学模型，构造包含控制执行性能缺陷模型的传递参数，建立包含控制执行性能缺陷估计的传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，构造触发条件检测方法。
可选地，传递参数为：
Figure BDA0003054771160000049
传递参数估计器表达式为：
Figure BDA0003054771160000051
增广状态估计器表达式为：
Figure BDA0003054771160000052
控制执行性能缺陷估计器表达式为：
Figure BDA0003054771160000053
其中，Ni为观测器增益矩阵，
Figure BDA0003054771160000054
为增广系统的输出估计。
可以理解的是，本步骤建立的观测器在步骤S1的基础上进行，用于对自适应巡航控制实际运行状态、感知设备和线控执行设备的性能缺陷进行综合估计，是构造主动容错控制率的重要信息。
可选地，构造触发条件检测方法进一步包括：
构造的雷达传感器相关的触发条件检测方法为：
Figure BDA0003054771160000055
构造的控制执行相关的触发条件检测方法为：
Figure BDA0003054771160000056
式中，Jth_rdi、Jth_rdi分别为雷达传感器测量相对距离、相对速度的性能缺陷阈值，Jthp为控制执行性能缺陷阈值。
可以理解的是，触发条件检测结果是主动容错控制率构造的关键组成，起到切换控制率的作用。
步骤S3，根据传递参数估计器、增广状态估计器和控制执行性能缺陷估计器输出的传递参数估计值、增广状态估计值、控制执行性能缺陷估计值、以及触发条件检测方法输出的触发条件检测结果，计算面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率。
可选地，面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率的计算公式为：
Figure BDA0003054771160000057
其中，uftci(t)为面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率，pi、qi分别为基于可测输出的反馈和基于V2X通信的前馈ucoi(t)的权重，K1i为增广系统的输出反馈增益矩阵，yi(t)为雷达传感器和加速度传感器测量值向量，∈1i、∈2i分别雷达传感器相关的触发条件检测结果和控制执行相关的触发条件检测结果，
Figure BDA0003054771160000061
为传递参数估计结果，αi为给定参数，Bp1i为增广系统的控制执行性能缺陷矩阵，
Figure BDA0003054771160000062
为增广状态向量估计值，
Figure BDA0003054771160000063
为传感器性能缺陷矩阵，O为零矩阵，I为单位矩阵。
步骤S4，将多性能缺陷主动容错控制率作为车辆驱动、制动控制执行的控制输入，生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度θ1和制动踏板开度θ2。
如图2所示，为整个方法的流程框图。本发明实施例的方法应用于自适应巡航控制的控制系统中，工作时，建立的传递参数估计器、增广状态估计器和执行系统性能缺陷估计器分别给出线控执行设备性能缺陷、自车与前车的相对距离误差、自车与前车的相对速度、自车加速度、感知设备的性能缺陷实时数值；构造的触发条件检测方法给出触发条件检测结果。上述估计值和触发条件检测值都将传入构造的面向协同式自适应巡航控制预期功能安全的主动容错控制率中，如图3、图4、图5所示，对比现有普通的控制方法，该控制率将生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度，保障系统的预期功能安全。
根据本发明实施例提出的面向协同自适应巡航控制预期功能安全的容错控制方法，以雷达传感器和车载惯性测量单元(IMU)为反馈输入、V2X协同信息为前馈输入，相对距离误差、相对速度和自车加速度为输出的，包含雷达传感器和控制执行系统性能缺陷的增广状态空间模型；在此模型的基础上构造传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，实时估计出协同式自适应巡航控制系统增广状态和性能缺陷；据此综合构造在线主动容错控制率，用于输入车辆底盘控制系统，生成加速踏板开度和制动踏板开度，可以弥补协同式自适应巡航控制感知和执行系统的功能不足，增强协同式自适应巡航控制功能的态势认知和场景适应能力，使之在多性能缺陷的状况下仍然能够安全稳定地运行，保障协同式自适应巡航预期功能安全。
其次参照附图描述根据本发明实施例提出的面向协同自适应巡航控制预期功能安全的容错控制装置。
图6为根据本发明一个实施例的面向协同自适应巡航控制预期功能安全的容错控制装置结构示意图。
如图6所示，该面向协同自适应巡航控制预期功能安全的容错控制装置包括：第一构造模块601、第二构造模块602、计算模块603和控制模块604。
第一构造模块601，用于建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型，以雷达传感器性能缺陷作为增广状态，构造增广的协同式自适应巡航控制系统数学模型。
第二构造模块602，用于根据增广的协同式自适应巡航控制系统数学模型，构造包含控制执行性能缺陷模型的传递参数，建立包含控制执行性能缺陷估计的传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，构造触发条件检测方法。
计算模块603，用于根据传递参数估计器、增广状态估计器和控制执行性能缺陷估计器输出的传递参数估计值、增广状态估计值、控制执行性能缺陷估计值、以及触发条件检测方法输出的触发条件检测结果，计算面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率。
控制模块604，用于将多性能缺陷主动容错控制率作为车辆驱动、制动控制执行的控制输入，生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度。
可选地，建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型为：
Figure BDA0003054771160000071
yi(t)＝Cixi(t)+Ps,ipi(t)
其中，
Figure BDA0003054771160000072
u＝[ai ai-1]T
xi＝[εi Δvi ai]T为系统状态向量，εi为相对距离误差，Δvi为相对速度，ai为自车加速度，ai-1为前车加速度，Bi为输入矩阵，u为控制输入，Ai为系统矩阵，h为车头时距，ζi为发动机时间常数，Bpi为执行器性能缺陷矩阵，fpi为执行器性能缺陷向量，Ci为输出矩阵，Ps,i为雷达传感器性能缺陷参数矩阵，pi为雷达传感器性能缺陷向量；
增广状态为
Figure BDA0003054771160000073
其中pi＝[prdi prvi]T，增广的协同式自适应巡航控制系统数学模型表达式为：
Figure BDA0003054771160000074
Figure BDA0003054771160000075
定义
Figure BDA0003054771160000076
C1i＝[Ci Ps，i]，简化的增广的协同式自适应巡航控制系统数学模型为：
Figure BDA0003054771160000077
Figure BDA0003054771160000078
其中，O为维度适当的零向量，I为维度适当的单位向量，prdi、prvi分别为雷达传感器由性能缺陷造成的对两车相对距离、相对速度测量的测量偏差数值。
可选地，传递参数为：
Figure BDA0003054771160000081
传递参数估计器表达式为：
Figure BDA0003054771160000082
增广状态估计器表达式为：
Figure BDA0003054771160000083
控制执行性能缺陷估计器表达式为：
Figure BDA0003054771160000084
其中，Ni为观测器增益矩阵，
Figure BDA0003054771160000085
为增广系统的输出估计。
可选地，构造触发条件检测方法进一步包括：
构造的雷达传感器相关的触发条件检测方法为：
Figure BDA0003054771160000086
构造的控制执行相关的触发条件检测方法为：
Figure BDA0003054771160000087
式中，Jth_rdi、Jth_rdi分别为雷达传感器测量相对距离、相对速度的性能缺陷阈值，Jthp为控制执行性能缺陷阈值。
可选地，面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率的计算公式为：
Figure BDA0003054771160000088
其中，uftci(t)为面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率，pi、qi分别为基于可测输出的反馈和基于V2X通信的前馈ucoi(t)的权重，K1i为增广系统的输出反馈增益矩阵，yi(t)为雷达传感器和加速度传感器测量值向量，∈1i、∈2i分别雷达传感器相关的触发条件检测结果和控制执行相关的触发条件检测结果，
Figure BDA0003054771160000089
为传递参数估计结果，αi为给定参数，Bp1i为增广系统的控制执行性能缺陷矩阵，
Figure BDA00030547711600000810
为增广状态向量估计值，
Figure BDA00030547711600000811
为传感器性能缺陷矩阵，O为零矩阵，I为单位矩阵。
需要说明的是，前述对方法实施例的解释说明也适用于该实施例的装置，此处不再赘述。
根据本发明实施例提出的面向协同自适应巡航控制预期功能安全的容错控制装置，以雷达传感器和车载惯性测量单元(IMU)为反馈输入、V2X协同信息为前馈输入，相对距离误差、相对速度和自车加速度为输出的，包含雷达传感器和控制执行系统性能缺陷的增广状态空间模型；在此模型的基础上构造传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，实时估计出协同式自适应巡航控制系统增广状态和性能缺陷；据此综合构造在线主动容错控制率，用于输入车辆底盘控制系统，生成加速踏板开度和制动踏板开度，可以弥补协同式自适应巡航控制感知和执行系统的功能不足，增强协同式自适应巡航控制功能的态势认知和场景适应能力，使之在多性能缺陷的状况下仍然能够安全稳定地运行，保障协同式自适应巡航预期功能安全。
此外，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本发明的描述中，“多个”的含义是至少两个，例如两个，三个等，除非另有明确具体的限定。
在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外，在不相互矛盾的情况下，本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (10)

1.一种面向协同自适应巡航控制预期功能安全的容错控制方法，其特征在于，包括以下步骤：
建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型，以雷达传感器性能缺陷作为增广状态，构造增广的协同式自适应巡航控制系统数学模型；
根据所述增广的协同式自适应巡航控制系统数学模型，构造包含控制执行性能缺陷模型的传递参数，建立包含控制执行性能缺陷估计的传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，构造触发条件检测方法；
根据所述传递参数估计器、所述增广状态估计器和所述控制执行性能缺陷估计器输出的传递参数估计值、增广状态估计值、控制执行性能缺陷估计值、以及所述触发条件检测方法输出的触发条件检测结果，计算面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率；
将所述多性能缺陷主动容错控制率作为车辆驱动、制动控制执行的控制输入，生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度。
2.根据权利要求1所述的方法，其特征在于，所述建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型为：
Figure FDA0003054771150000011
yi(t)＝Cixi(t)+Ps，ipi(t)
其中，
Figure FDA0003054771150000012
u＝[ai ai-1]T
xi＝[εi Δvi ai]T为系统状态向量，εi为相对距离误差，Δvi为相对速度，ai为自车加速度，ai-1为前车加速度，Bi为输入矩阵，u为控制输入，Ai为系统矩阵，h为车头时距，ζi为发动机时间常数，Bpi为执行器性能缺陷矩阵，fpi为执行器性能缺陷向量，Ci为输出矩阵，Ps，i为雷达传感器性能缺陷参数矩阵，pi为雷达传感器性能缺陷向量。
3.根据权利要求2所述的方法，其特征在于，所述增广状态为
Figure FDA0003054771150000013
其中pi＝[prdi prvi]T，所述增广的协同式自适应巡航控制系统数学模型表达式为：
Figure FDA0003054771150000014
Figure FDA0003054771150000021
定义
Figure FDA0003054771150000022
C1i＝[Ci Ps，i]，简化的增广的协同式自适应巡航控制系统数学模型为：
Figure FDA0003054771150000023
Figure FDA0003054771150000024
其中，O为维度适当的零向量，I为维度适当的单位向量，prdi、prvi分别为雷达传感器由性能缺陷造成的对两车相对距离、相对速度测量的测量偏差数值。
4.根据权利要求3所述的方法，其特征在于，所述传递参数为：
Figure FDA0003054771150000025
所述传递参数估计器表达式为：
Figure FDA0003054771150000026
所述增广状态估计器表达式为：
Figure FDA0003054771150000027
所述控制执行性能缺陷估计器表达式为：
Figure FDA0003054771150000028
其中，Ni为观测器增益矩阵，
Figure FDA0003054771150000029
为增广系统的输出估计。
5.根据权利要求4所述的方法，其特征在于，所述构造触发条件检测方法进一步包括：
构造的雷达传感器相关的触发条件检测方法为：
Figure FDA00030547711500000210
构造的控制执行相关的触发条件检测方法为：
Figure FDA00030547711500000211
式中，Jth_rdi、Jth_rdi分别为雷达传感器测量相对距离、相对速度的性能缺陷阈值，Jthp为控制执行性能缺陷阈值。
6.根据权利要求5所述的方法，其特征在于，所述面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率的计算公式为：
Figure FDA00030547711500000212
其中，uftci(t)为面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率，pi、qi分别为基于可测输出的反馈和基于V2X通信的前馈ucoi(t)的权重，K1i为增广系统的输出反馈增益矩阵，yi(t)为雷达传感器和加速度传感器测量值向量，∈1i、∈2i分别雷达传感器相关的触发条件检测结果和控制执行相关的触发条件检测结果，
Figure FDA0003054771150000031
为传递参数估计结果，αi为给定参数，Bp1i为增广系统的控制执行性能缺陷矩阵，
Figure FDA0003054771150000032
为增广状态向量估计值，
Figure FDA0003054771150000033
为传感器性能缺陷矩阵，O为零矩阵，I为单位矩阵。
7.一种面向协同自适应巡航控制预期功能安全的容错控制装置，其特征在于，包括：
第一构造模块，用于建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型，以雷达传感器性能缺陷作为增广状态，构造增广的协同式自适应巡航控制系统数学模型；
第二构造模块，用于根据所述增广的协同式自适应巡航控制系统数学模型，构造包含控制执行性能缺陷模型的传递参数，建立包含控制执行性能缺陷估计的传递参数估计器、增广状态估计器和控制执行性能缺陷估计器，构造触发条件检测方法；
计算模块，用于根据所述传递参数估计器、所述增广状态估计器和所述控制执行性能缺陷估计器输出的传递参数估计值、增广状态估计值、控制执行性能缺陷估计值、以及所述触发条件检测方法输出的触发条件检测结果，计算面向协同式自适应巡航控制预期功能安全的多性能缺陷主动容错控制率；
控制模块，用于将所述多性能缺陷主动容错控制率作为车辆驱动、制动控制执行的控制输入，生成可容忍协同式自适应巡航控制系统性能缺陷的车辆加速踏板开度和制动踏板开度。
8.根据权利要求7所述的装置，其特征在于，所述建立包含雷达传感器和驱动、制动控制执行性能缺陷的协同式自适应巡航控制系统数学模型为：
Figure FDA0003054771150000034
yi(t)＝Cixi(t)+Ps，ipi(t)
其中，
Figure FDA0003054771150000035
u＝[ai ai-1]T
xi＝[εi Δvi ai]T为系统状态向量，εi为相对距离误差，Δvi为相对速度，ai为自车加速度，ai-1为前车加速度，Bi为输入矩阵，u为控制输入，Ai为系统矩阵，h为车头时距，ζi为发动机时间常数，Bpi为执行器性能缺陷矩阵，fpi为执行器性能缺陷向量，Ci为输出矩阵，Ps，i为雷达传感器性能缺陷参数矩阵，pi为雷达传感器性能缺陷向量；
所述增广状态为
Figure FDA0003054771150000041
其中pi＝[prdi prvi]T，所述增广的协同式自适应巡航控制系统数学模型表达式为：
Figure FDA0003054771150000042
Figure FDA0003054771150000043
定义
Figure FDA0003054771150000044
C1i＝[Ci Ps，i]，简化的增广的协同式自适应巡航控制系统数学模型为：
Figure FDA0003054771150000045
Figure FDA0003054771150000046
其中，O为维度适当的零向量，I为维度适当的单位向量，prdi、prvi分别为雷达传感器由性能缺陷造成的对两车相对距离、相对速度测量的测量偏差数值。
9.根据权利要求7所述的装置，其特征在于，所述传递参数为：
Figure FDA0003054771150000047
所述传递参数估计器表达式为：
Figure FDA0003054771150000048
所述增广状态估计器表达式为：
Figure FDA0003054771150000049
所述控制执行性能缺陷估计器表达式为：
Figure FDA00030547711500000410
其中，Ni为观测器增益矩阵，
Figure FDA00030547711500000411
为增广系统的输出估计。
10.根据权利要求7所述的装置，其特征在于，所述构造触发条件检测方法进一步包括：
构造的雷达传感器相关的触发条件检测方法为：
Figure FDA00030547711500000412
构造的控制执行相关的触发条件检测方法为：
Figure FDA00030547711500000413
式中，Jth_rdi、Jth_rdi分别为雷达传感器测量相对距离、相对速度的性能缺陷阈值，Jthp为控制执行性能缺陷阈值。
CN202110496863.2A 2021-05-07 2021-05-07 面向协同自适应巡航控制预期功能安全的容错控制方法 Active CN113147763B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110496863.2A CN113147763B (zh) 2021-05-07 2021-05-07 面向协同自适应巡航控制预期功能安全的容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110496863.2A CN113147763B (zh) 2021-05-07 2021-05-07 面向协同自适应巡航控制预期功能安全的容错控制方法

Publications (2)

Publication Number Publication Date
CN113147763A true CN113147763A (zh) 2021-07-23
CN113147763B CN113147763B (zh) 2022-08-30

Family

ID=76873649

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110496863.2A Active CN113147763B (zh) 2021-05-07 2021-05-07 面向协同自适应巡航控制预期功能安全的容错控制方法

Country Status (1)

Country Link
CN (1) CN113147763B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113741194A (zh) * 2021-09-09 2021-12-03 河海大学 基于切换非线性电子线路系统的自适应容错控制方法及系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108715163A (zh) * 2018-05-14 2018-10-30 吕杉 汽车爆胎安全稳定控制系统
CN111422247A (zh) * 2020-03-20 2020-07-17 合肥工业大学 线控转向电机和传感器的故障诊断及容错补偿算法
WO2021078660A1 (de) * 2019-10-23 2021-04-29 Thyssenkrupp Presta Ag Auswertevorrichtung zur fehlertoleranten auswertung von sensorsignalen für ein motorsteuergerät einer kraftfahrzeuglenkung und kraftfahrzeuglenkung

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108715163A (zh) * 2018-05-14 2018-10-30 吕杉 汽车爆胎安全稳定控制系统
WO2021078660A1 (de) * 2019-10-23 2021-04-29 Thyssenkrupp Presta Ag Auswertevorrichtung zur fehlertoleranten auswertung von sensorsignalen für ein motorsteuergerät einer kraftfahrzeuglenkung und kraftfahrzeuglenkung
CN111422247A (zh) * 2020-03-20 2020-07-17 合肥工业大学 线控转向电机和传感器的故障诊断及容错补偿算法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
ELLEN VAN NUNEN ET AL: "Fault Tolerancy in Cooperative Adaptive Cruise Control", 《PROCEEDINGS OF THE 16TH INTERNATIONAL IEEE ANNUAL CONFERENCE ON》 *
HUA ZHANG ET AL: "Active Fault Tolerant Control of Adaptive Cruise", 《IEEE ACCESS》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113741194A (zh) * 2021-09-09 2021-12-03 河海大学 基于切换非线性电子线路系统的自适应容错控制方法及系统
CN113741194B (zh) * 2021-09-09 2022-04-15 河海大学 基于切换非线性电子线路系统的自适应容错控制方法及系统

Also Published As

Publication number Publication date
CN113147763B (zh) 2022-08-30

Similar Documents

Publication Publication Date Title
EP3056404B1 (en) Vehicle motion control device
Rajamani et al. Parameter and state estimation in vehicle roll dynamics
CN106515733B (zh) 车辆的控制装置
Yang et al. Adaptive estimation of road gradient and vehicle parameters for vehicular systems
Idriz et al. Integration of auto‐steering with adaptive cruise control for improved cornering behaviour
Zhang et al. Cooperative chassis control system of electric vehicles for agility and stability improvements
Cao et al. Analysis and design of adaptive cruise control for smart electric vehicle with domain-based poly-service loop delay
CN113147763B (zh) 面向协同自适应巡航控制预期功能安全的容错控制方法
Cabello et al. Design and validation of a fuzzy longitudinal controller based on a vehicle dynamic simulator
Kim Design of the adaptive cruise control systems: an optimal control approach
Druzhinina et al. Adaptive continuously variable compression braking control for heavy-duty vehicles
Cao et al. Autonomous emergency braking of electric vehicles with high robustness to cyber-physical uncertainties for enhanced braking stability
Shaohua et al. Automatic emergency braking/anti‐lock braking system coordinated control with road adhesion coefficient estimation for heavy vehicle
Ying et al. Research on adaptive cruise control systems and performance analysis using Matlab and Carsim
Jiang et al. Acceleration‐based wheel slip control realized with decentralised electric drivetrain systems
Liu et al. An Innovative Adaptive Cruise Control Method Based on Mixed H₂/H∞ Out-of-Sequence Measurement Observer
CN113589690A (zh) 协同自适应巡航控制鲁棒容错方法及装置
Ng et al. Reinforcement learning of adaptive longitudinal vehicle control for dynamic collaborative driving
Gao et al. Longitudinal velocity estimation of electric vehicle with 4 in-wheel motors
Zhang et al. Distributed drive electric vehicle longitudinal velocity estimation with adaptive kalman filter: Theory and experiment
Bingöl et al. String stability under actuator saturation on straight level roads: sufficient conditions and optimal trajectory generation
Liu et al. Improved model predictive control for cooperative adaptive cruise control subject to actuator delay
El-bakkouri et al. Extended Luenberger Observer for ABS Braking System
CN113602269B (zh) 面向协同自适应巡航控制预期功能安全的容错方法及装置
Wu et al. Heavy-duty vehicle longitudinal automation with hydraulic retarder via H infinity control and off-policy reinforcement learning

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