[go: up one dir, main page]

CN118810829A - A Steering-Differential Yaw Stability Control Method for Actuator Failure - Google Patents

A Steering-Differential Yaw Stability Control Method for Actuator Failure Download PDF

Info

Publication number
CN118810829A
CN118810829A CN202411220616.XA CN202411220616A CN118810829A CN 118810829 A CN118810829 A CN 118810829A CN 202411220616 A CN202411220616 A CN 202411220616A CN 118810829 A CN118810829 A CN 118810829A
Authority
CN
China
Prior art keywords
control
yaw
actuator
vehicle
matrix
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.)
Pending
Application number
CN202411220616.XA
Other languages
Chinese (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 CN202411220616.XA priority Critical patent/CN118810829A/en
Publication of CN118810829A publication Critical patent/CN118810829A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/04Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/18Conjoint control of vehicle sub-units of different type or different function including control of braking systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • B60W50/02Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
    • B60W50/0205Diagnosing or detecting failures; Failure detection models
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • B60W50/02Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
    • B60W50/0225Failure correction strategy
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/408Radar; Laser, e.g. lidar
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2710/00Output or target parameters relating to a particular sub-units
    • B60W2710/18Braking system
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2710/00Output or target parameters relating to a particular sub-units
    • B60W2710/20Steering systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Human Computer Interaction (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

本发明公开了一种面向执行器失效的转向‑差动横摆稳定控制方法,本发明的方法包括基于车辆动力学状态信息、故障信息与环境信息并根据上一时刻计算的目标执行命令与实际执行命令的差值矩阵计算约束辅助变量;基于径向基函数神经网络对横摆稳定控制扰动矩阵进行观测拟合,以得到横摆稳定控制的扰动矩阵观测值;基于约束辅助变量和扰动矩阵观测值计算中间控制变量目标值;基于执行器执行能力对中间控制变量目标值进行分配,计算执行器执行的控制命令;通过执行器执行对应控制命令。本发明在执行器故障场景下,充分利用剩余执行能力,减少由于执行能力下降导致横摆跟踪性能下降,使得差动转向参与横摆控制过程更加安全稳定。

The present invention discloses a steering-differential yaw stability control method for actuator failure, the method of the present invention includes calculating constraint auxiliary variables based on vehicle dynamics state information, fault information and environmental information and according to the difference matrix between the target execution command calculated at the last moment and the actual execution command; observing and fitting the yaw stability control disturbance matrix based on a radial basis function neural network to obtain the disturbance matrix observation value of the yaw stability control; calculating the intermediate control variable target value based on the constraint auxiliary variable and the disturbance matrix observation value; allocating the intermediate control variable target value based on the actuator execution capability, calculating the control command executed by the actuator; and executing the corresponding control command through the actuator. In the actuator failure scenario, the present invention makes full use of the remaining execution capability, reduces the yaw tracking performance degradation caused by the decline in execution capability, and makes the differential steering participation in the yaw control process safer and more stable.

Description

一种面向执行器失效的转向-差动横摆稳定控制方法A Steering-Differential Yaw Stability Control Method for Actuator Failure

技术领域Technical Field

本发明涉及智能汽车控制技术领域,特别是涉及一种面向执行器失效的转向-差动横摆稳定控制方法。The invention relates to the technical field of intelligent automobile control, and in particular to a steering-differential yaw stability control method facing actuator failure.

背景技术Background Art

随着汽车智能技术的发展,高级别自动驾驶功能对于车辆的执行要求越来越高,对于车辆安全需求越来越高。而车辆底盘转向、驱动和制动系统的集成与协调控制是提高车辆安全性和驾驶性能的关键技术。不同系统的协调也在单一执行系统故障后为车辆提供了跨系统的执行解决方案,如依赖驱动/制动系统对于转向系统的冗余备份。With the development of intelligent automotive technology, high-level autonomous driving functions have increasingly higher requirements for vehicle execution and vehicle safety. The integration and coordinated control of the vehicle chassis steering, drive and braking systems are key technologies to improve vehicle safety and driving performance. The coordination of different systems also provides a cross-system execution solution for the vehicle after a single execution system fails, such as relying on the redundant backup of the steering system by the drive/brake system.

传统的车辆横摆稳定控制依赖执行器的正常运行,并且采用分层的控制架构,横摆控制之后直接进行执行器命令分配。但是当一个或者多个关键执行器失效后,执行子系统的执行能力受到限制,可能对于原有横摆控制命令较难实现。在执行器部分或完全失效的情况下,现有技术未能提供一种有效的解决方案来维持车辆的横摆稳定性,尤其是在紧急操控或极端驾驶条件下。Traditional vehicle yaw stability control relies on the normal operation of the actuators and adopts a hierarchical control architecture, where actuator commands are directly distributed after yaw control. However, when one or more key actuators fail, the execution capability of the execution subsystem is limited, and it may be difficult to implement the original yaw control command. In the case of partial or complete failure of the actuator, the existing technology fails to provide an effective solution to maintain the yaw stability of the vehicle, especially in emergency maneuvers or extreme driving conditions.

随着自动驾驶和域控技术的进步,车辆对于自身控制更加精确,车辆对于故障工况下的安全需求也更高,故障后车辆的失效运行控制变得尤为重要,因此,开发一种能够在智能汽车转向、驱动或制动执行器失效时,面对执行子系统执行能力降级时依然能够维持车辆横摆稳定性的控制方法尤为重要。With the advancement of autonomous driving and domain control technologies, vehicles have more precise control over themselves and higher safety requirements under fault conditions. Failure operation control of vehicles after a fault becomes particularly important. Therefore, it is particularly important to develop a control method that can maintain the vehicle's yaw stability when the steering, drive or brake actuators of smart cars fail and the execution capability of the execution subsystem is degraded.

发明内容Summary of the invention

本发明旨在至少在一定程度上解决相关技术中的技术问题之一。The present invention aims to solve one of the technical problems in the related art at least to a certain extent.

为此本发明提出一种面向执行器失效的转向-差动横摆稳定控制系统,针对横摆控制器输出执行命令与实际执行的偏差,通过设计约束辅助变量调整横摆控制器的输出,减少横摆控制器与下层执行命令分配的偏差,满足了故障场景下转向-差动横摆稳定控制的多种性能指标与安全需求。To this end, the present invention proposes a steering-differential yaw stability control system for actuator failure. Aiming at the deviation between the execution command output by the yaw controller and the actual execution, the output of the yaw controller is adjusted by designing constrained auxiliary variables, thereby reducing the deviation between the yaw controller and the lower-level execution command allocation, thereby meeting various performance indicators and safety requirements of the steering-differential yaw stability control in fault scenarios.

本发明的另一个目的在于提出一种面向执行器失效的转向-差动横摆稳定控制方法。Another object of the present invention is to provide a steering-differential yaw stability control method for actuator failure.

为达上述目的,本发明一方面提出一种面向执行器失效的转向-差动横摆稳定控制系统,包括传感器组合模块、动力学融合观测模块、横摆跟踪控制模块和执行机构子系统;其中,To achieve the above-mentioned object, the present invention proposes a steering-differential yaw stability control system for actuator failure, comprising a sensor combination module, a dynamic fusion observation module, a yaw tracking control module and an actuator subsystem; wherein,

所述传感器组合模块,用于输出车辆相关传感信息;The sensor combination module is used to output vehicle-related sensor information;

所述动力学融合观测模块,用于接收所述车辆相关传感信息并输出车辆动力学状态反馈信息和车辆执行器故障状态反馈信息;The dynamics fusion observation module is used to receive the vehicle-related sensor information and output vehicle dynamics state feedback information and vehicle actuator fault state feedback information;

所述横摆跟踪控制模块,用于接收自驾系统或车辆驾驶员输入的横摆跟踪角速度控制命令,并根据接收的车辆执行器故障状态反馈信息计算执行器剩余执行能力,同时根据接收的车辆动力学状态反馈信息进行横摆跟踪稳定控制反馈控制,并输出用于执行机构子系统的控制命令。The yaw tracking control module is used to receive the yaw tracking angular velocity control command input by the self-driving system or the vehicle driver, and calculate the actuator's remaining execution capacity based on the received vehicle actuator fault state feedback information, and perform yaw tracking stability control feedback control based on the received vehicle dynamics state feedback information, and output a control command for the actuator subsystem.

本发明实施例的面向执行器失效的转向-差动横摆稳定控制系统还可以具有以下附加技术特征:The steering-differential yaw stability control system for actuator failure according to the embodiment of the present invention may also have the following additional technical features:

在本发明的一个实施例中,所述横摆跟踪控制模块,包括:In one embodiment of the present invention, the yaw tracking control module comprises:

执行约束辅助单元,用于根据目标执行命令与实际执行命令的差值,计算约束辅助变量,以辅助横摆稳定控制;An execution constraint auxiliary unit, used for calculating a constraint auxiliary variable according to a difference between a target execution command and an actual execution command, so as to assist yaw stability control;

扰动观测单元,用于计算横摆稳定控制扰动矩阵的观测值;A disturbance observation unit, used to calculate the observation value of the yaw stability control disturbance matrix;

横摆稳定控制单元,用于基于约束辅助变量和扰动矩阵的观测值并根据横摆控制目标与车辆动力学状态反馈信息计算横摆稳定控制的控制变量目标值;A yaw stability control unit, for calculating a control variable target value of yaw stability control based on the observation value of the constraint auxiliary variable and the disturbance matrix and according to the yaw control target and the vehicle dynamics state feedback information;

执行命令分配单元,用于对横摆稳定控制单元产生的控制变量目标值进行执行器分配,以生成前轮转向角、制动系统与驱动系统控制命令。The execution command distribution unit is used to distribute the actuator to the control variable target value generated by the yaw stability control unit to generate the front wheel steering angle, braking system and driving system control commands.

在本发明的一个实施例中,所述执行约束辅助单元,用于接收上一时刻执行命令分配单元计算得到的目标执行命令与实际执行命令的差值,并基于差值构建计算约束辅助变量,并将所述约束辅助变量发送给横摆稳定控制单元;In one embodiment of the present invention, the execution constraint auxiliary unit is used to receive the difference between the target execution command calculated by the execution command allocation unit at the previous moment and the actual execution command, and construct a calculation constraint auxiliary variable based on the difference, and send the constraint auxiliary variable to the yaw stability control unit;

所述扰动观测单元,用于通过输入系统的横摆控制目标与车辆动力学状态反馈状态差值进行扰动观测,采用径向基函数神经网络对横摆稳定控制扰动进行观测拟合,并将拟合的扰动矩阵观测值发送给横摆稳定控制单元进行前馈控制;The disturbance observation unit is used to perform disturbance observation by inputting the difference between the yaw control target of the system and the feedback state of the vehicle dynamics state, observe and fit the yaw stability control disturbance using a radial basis function neural network, and send the fitted disturbance matrix observation value to the yaw stability control unit for feedforward control;

所述横摆稳定控制单元,用于接收约束辅助变量和扰动矩阵观测值,并根据输入系统的横摆控制目标与动力学状态反馈状态差值进行反馈控制,计算横摆稳定控制的中间控制变量;当约束辅助变量不为零时,根据约束辅助变量调整中间控制变量输出,并输出给执行命令分配单元;The yaw stability control unit is used to receive the constraint auxiliary variable and the disturbance matrix observation value, and perform feedback control according to the yaw control target of the input system and the dynamic state feedback state difference, and calculate the intermediate control variable of the yaw stability control; when the constraint auxiliary variable is not zero, adjust the intermediate control variable output according to the constraint auxiliary variable, and output it to the execution command allocation unit;

所述执行命令分配单元,用于接收中间控制变量的输入,并结合执行器剩余执行能力、整车驱动需求进行执行器命令分配,以生成执行机构子系统的执行命令,并计算执行分配误差。The execution command allocation unit is used to receive the input of the intermediate control variable, and to allocate the actuator command in combination with the remaining execution capacity of the actuator and the driving demand of the whole vehicle, so as to generate the execution command of the actuator subsystem and calculate the execution allocation error.

在本发明的一个实施例中,所述传感器组合模块,包括激光雷达、摄像头组合、GPS、IMU中的多种;所述执行机构子系统,包括:四轮独立制动的线控制动系统、四轮独立驱动的线控驱动系统、线控转向系统;所述动力学融合观测模块,包括故障识别单元与动力学状态识别单元;其中,In one embodiment of the present invention, the sensor combination module includes multiple types of laser radar, camera combination, GPS, and IMU; the actuator subsystem includes: a wire-controlled brake system for four-wheel independent braking, a wire-controlled drive system for four-wheel independent driving, and a wire-controlled steering system; the dynamics fusion observation module includes a fault identification unit and a dynamics state identification unit; wherein,

所述动力学融合观测模块接收传感器组合模块输出的车辆相关传感信息与执行机构子系统反馈的执行机构传感反馈信息;分别通过故障识别单元与动力学状态识别单元对所述车辆相关传感信息和所述执行机构传感反馈信息进行融合计算得到对应的车辆执行器故障状态反馈信息与车辆动力学状态反馈信息,并传输至横摆跟踪控制模块。The dynamic fusion observation module receives the vehicle-related sensor information output by the sensor combination module and the actuator sensor feedback information fed back by the actuator subsystem; the vehicle-related sensor information and the actuator sensor feedback information are fused and calculated by the fault identification unit and the dynamic state identification unit respectively to obtain the corresponding vehicle actuator fault state feedback information and vehicle dynamic state feedback information, and transmit them to the yaw tracking control module.

为达上述目的,本发明另一方面提出一种面向执行器失效的转向-差动横摆稳定控制方法,包括:To achieve the above object, the present invention provides, on the other hand, a steering-differential yaw stability control method for actuator failure, comprising:

获取车辆动力学状态信息、故障信息与环境信息;Obtain vehicle dynamics status information, fault information and environmental information;

基于所述车辆动力学状态信息、故障信息与环境信息并根据上一时刻计算的目标执行命令与实际执行命令的差值矩阵计算约束辅助变量;Calculating constraint auxiliary variables based on the vehicle dynamics state information, fault information and environmental information and according to a difference matrix between a target execution command calculated at a previous moment and an actual execution command;

基于径向基函数神经网络对横摆稳定控制扰动矩阵进行观测拟合,以得到横摆稳定控制的扰动矩阵观测值;Based on the radial basis function neural network, the disturbance matrix of yaw stability control is fitted to obtain the observation value of the disturbance matrix of yaw stability control;

基于约束辅助变量和扰动矩阵观测值计算中间控制变量目标值;Calculate the target value of the intermediate control variable based on the constraint auxiliary variables and the disturbance matrix observation value;

基于执行器执行能力对中间控制变量目标值进行分配,计算执行器执行的控制命令;Assigning target values of intermediate control variables based on the execution capabilities of the actuators and calculating control commands executed by the actuators;

通过执行器执行对应控制命令,其中,四轮驱动/制动力矩中正值由对应执行器的车轮驱动系统执行,负值由执行器的对应车轮制动和驱动系统协调控制,前轮转向角命令由执行器的转向系统执行。The corresponding control command is executed by the actuator, wherein the positive value of the four-wheel drive/braking torque is executed by the wheel drive system of the corresponding actuator, the negative value is coordinated and controlled by the corresponding wheel braking and drive system of the actuator, and the front wheel steering angle command is executed by the steering system of the actuator.

本发明实施例的面向执行器失效的转向-差动横摆稳定控制系统和方法,需要能够动态调整横摆控制命令输出,根据剩余执行器的实际运行状态优化横摆力矩的分配,从而在执行器部分失效时也能保证车辆的安全和稳定性,满足了故障场景下转向-差动横摆稳定控制的多种性能指标与安全需求。The steering-differential yaw stability control system and method for actuator failure in the embodiments of the present invention need to be able to dynamically adjust the yaw control command output and optimize the distribution of yaw torque according to the actual operating status of the remaining actuators, so as to ensure the safety and stability of the vehicle even when some actuators fail, thereby meeting the various performance indicators and safety requirements of the steering-differential yaw stability control in fault scenarios.

本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention.

附图说明BRIEF DESCRIPTION OF THE DRAWINGS

本发明上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解,其中:The above and/or additional aspects and advantages of the present invention will become apparent and easily understood from the following description of the embodiments in conjunction with the accompanying drawings, in which:

图1是根据本发明实施例的面向执行器失效的转向-差动横摆稳定控制系统的结构图;1 is a structural diagram of a steering-differential yaw stability control system for actuator failure according to an embodiment of the present invention;

图2是根据本发明实施例的面向执行器失效的转向-差动横摆稳定控制方法的流程图。FIG. 2 is a flow chart of a steering-differential yaw stability control method for actuator failure according to an embodiment of the present invention.

具体实施方式DETAILED DESCRIPTION

需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments can be combined with each other. The present invention will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.

下面参照附图描述根据本发明实施例提出的面向执行器失效的转向-差动横摆稳定控制系统和方法。The following describes a steering-differential yaw stability control system and method for actuator failure according to an embodiment of the present invention with reference to the accompanying drawings.

图1是根据本发明实施例的面向执行器失效的转向-差动横摆稳定控制系统的结构图,如图1所示,传感器组合模块100、动力学融合观测模块200、横摆跟踪控制模块300和执行机构子系统400;其中,FIG1 is a structural diagram of a steering-differential yaw stability control system for actuator failure according to an embodiment of the present invention. As shown in FIG1 , a sensor combination module 100, a dynamics fusion observation module 200, a yaw tracking control module 300 and an actuator subsystem 400 are provided; wherein,

传感器组合模块100,用于输出车辆相关传感信息;The sensor combination module 100 is used to output vehicle-related sensor information;

动力学融合观测模块200,用于接收所述车辆相关传感信息并输出车辆动力学状态反馈信息和车辆执行器故障状态反馈信息;A dynamics fusion observation module 200, used to receive the vehicle-related sensor information and output vehicle dynamics state feedback information and vehicle actuator fault state feedback information;

横摆跟踪控制模块300,用于接收自驾系统或车辆驾驶员输入的横摆跟踪角速度控制命令,并根据接收的车辆执行器故障状态反馈信息计算执行器剩余执行能力,同时根据接收的车辆动力学状态反馈信息进行横摆跟踪稳定控制反馈控制,并输出用于执行机构子系统400的控制命令。The yaw tracking control module 300 is used to receive the yaw tracking angular velocity control command input by the self-driving system or the vehicle driver, and calculate the actuator's remaining execution capacity based on the received vehicle actuator fault state feedback information, and perform yaw tracking stability control feedback control based on the received vehicle dynamics state feedback information, and output a control command for the actuator subsystem 400.

可以理解的是,本发明目的是针对高级别自动驾驶车辆,结合故障信息、环境信息、车辆状态信息进行执行器失效故障场景下的差动-转向横摆稳定控制,在满足车辆稳定运行要求下尽可能充分利用执行器剩余执行能力。It can be understood that the purpose of the present invention is to perform differential-steering yaw stability control in actuator failure scenarios for high-level autonomous driving vehicles by combining fault information, environmental information, and vehicle status information, so as to make full use of the actuator's remaining execution capacity as much as possible while meeting the vehicle's stable operation requirements.

在本发明的一个实施例中,横摆跟踪控制模块300,包括:执行约束辅助单元,计算得到的目标执行命令与实际执行命令差值,计算约束辅助变量,辅助横摆稳定控制;扰动观测单元,计算横摆稳定控制扰动矩阵的观测值;横摆稳定控制单元,结合约束辅助变量和扰动矩阵观测值并基于横摆控制目标与动力学状态反馈信息计算横摆稳定控制的控制变量目标值;执行命令分配单元,对横摆稳定控制单元产生的目标执行命令进行执行器分配,生成前轮转向角、制动系统与驱动系统控制命令。In one embodiment of the present invention, the yaw tracking control module 300 includes: an execution constraint auxiliary unit, which calculates the difference between the target execution command and the actual execution command, calculates the constraint auxiliary variable, and assists the yaw stability control; a disturbance observation unit, which calculates the observation value of the yaw stability control disturbance matrix; a yaw stability control unit, which combines the constraint auxiliary variable and the disturbance matrix observation value and calculates the control variable target value of the yaw stability control based on the yaw control target and the dynamic state feedback information; an execution command allocation unit, which performs actuator allocation on the target execution command generated by the yaw stability control unit, and generates the front wheel steering angle, braking system and drive system control commands.

优选地,执行约束辅助单元,接受上一时刻分配模块计算得到的目标执行命令与实际执行命令差值,并基于执行命令差值构建计算约束辅助变量,传递给横摆稳定控制单元。Preferably, the execution constraint auxiliary unit receives the difference between the target execution command and the actual execution command calculated by the allocation module at the previous moment, and constructs a calculation constraint auxiliary variable based on the execution command difference, and transmits it to the yaw stability control unit.

优选地,扰动观测单元,通过输入系统的横摆控制目标与动力学状态反馈状态差值进行扰动观测,可采用径向基函数神经网络对横摆稳定控制扰动进行观测拟合,并传递给横摆稳定控制单元进行前馈控制。Preferably, the disturbance observation unit performs disturbance observation by inputting the system's yaw control target and the dynamic state feedback state difference, and can use a radial basis function neural network to observe and fit the yaw stability control disturbance, and transmit it to the yaw stability control unit for feedforward control.

优选地,横摆稳定控制单元,接受约束辅助变量、扰动矩阵观测值,并根据输入系统的横摆控制目标与动力学状态反馈状态差值进行反馈控制,计算横摆稳定控制的中间控制变量。当约束辅助变量不为零时,需要根据约束辅助变量调整中间控制变量输出,并传递给执行命令分配单元。Preferably, the yaw stability control unit receives the constraint auxiliary variable and the disturbance matrix observation value, performs feedback control according to the yaw control target of the input system and the dynamic state feedback state difference, and calculates the intermediate control variable of the yaw stability control. When the constraint auxiliary variable is not zero, the intermediate control variable output needs to be adjusted according to the constraint auxiliary variable and transmitted to the execution command allocation unit.

优选地,执行命令分配单元,接受中间控制变量输入,并结合剩余执行能力、整车驱动需求等进行执行器命令分配,同时为了减少因为执行能力不足导致的横摆跟踪性能变差,分配过程约束由于执行分配误差导致的横摆稳定控制性能(控制李雅普诺夫函数导数)恶化程度,尽可能减少对于整体控制效果影响。最后生成执行机构控制子系统执行命令传递给执行机构子系统,并计算执行分配误差。Preferably, the execution command allocation unit receives the input of the intermediate control variable, and allocates the actuator command in combination with the remaining execution capacity, the vehicle drive demand, etc. At the same time, in order to reduce the deterioration of the yaw tracking performance caused by insufficient execution capacity, the allocation process constrains the deterioration of the yaw stability control performance (control of the derivative of the Lyapunov function) caused by the execution allocation error, and minimizes the impact on the overall control effect. Finally, the execution command of the actuator control subsystem is generated and transmitted to the actuator subsystem, and the execution allocation error is calculated.

在本发明的一个实施例中,动力学融合观测模块200,接受传感器组合传递的传感信息与执行机构子系统反馈的执行机构传感反馈信息,分别由故障识别单元与动力学状态识别单元进行融合计算得到车辆执行器故障状态反馈信息与车辆动力学状态反馈信息,并传递给横摆跟踪控制模块。In one embodiment of the present invention, the dynamic fusion observation module 200 receives the sensor information transmitted by the sensor combination and the actuator sensor feedback information fed back by the actuator subsystem, and the fault identification unit and the dynamic state identification unit respectively perform fusion calculations to obtain the vehicle actuator fault state feedback information and the vehicle dynamic state feedback information, and transmit them to the yaw tracking control module.

在本发明的一个实施例中,传感器组合模块100,包括激光雷达、摄像头组合、GPS、IMU等,并将测得的车辆相关传感信息传递给动力学融合观测模块200。In one embodiment of the present invention, the sensor combination module 100 includes a laser radar, a camera combination, a GPS, an IMU, etc., and transmits the measured vehicle-related sensor information to the dynamics fusion observation module 200.

在本发明的一个实施例中,执行机构子系统400,包括:四轮独立制动的线控制动系统、四轮独立驱动的线控驱动系统、线控转向系统,执行机构子系统执行横摆跟踪模块生成的执行机构子系统执行命令。In one embodiment of the present invention, the actuator subsystem 400 includes: a wire-controlled brake system for four-wheel independent braking, a wire-controlled drive system for four-wheel independent driving, and a wire-controlled steering system. The actuator subsystem executes the actuator subsystem execution command generated by the yaw tracking module.

根据本发明实施例的面向执行器失效的转向-差动横摆稳定控制系统,在车辆的横摆稳定控制流程中引入执行约束辅助单元,从而将动力学层面的横摆稳定控制与底层执行层面的执行命令分配任务进行反馈配合,在横摆稳定控制输出超出现有剩余执行能力时,可以快速自适应的调整输出,减少由于执行命令分配与横摆稳定控制输出失配导致的系统不稳定风险。According to the steering-differential yaw stability control system for actuator failure according to the embodiment of the present invention, an execution constraint auxiliary unit is introduced into the yaw stability control process of the vehicle, so that the yaw stability control at the dynamic level and the execution command allocation task at the underlying execution level are feedback coordinated. When the yaw stability control output exceeds the existing remaining execution capacity, the output can be adjusted quickly and adaptively, thereby reducing the risk of system instability caused by the mismatch between the execution command allocation and the yaw stability control output.

为了实现上述实施例,如图2所示,本实施例中还提供了面向执行器失效的转向-差动横摆稳定控制方法,包括:In order to implement the above embodiment, as shown in FIG2 , this embodiment further provides a steering-differential yaw stability control method for actuator failure, including:

S1,获取车辆动力学状态信息、故障信息与环境信息。S1, obtain vehicle dynamics status information, fault information and environmental information.

可以理解的是,本发明在获取车辆动力学状态、故障信息与环境信息进行融合计算。It can be understood that the present invention obtains the vehicle dynamics state, fault information and environmental information for fusion calculation.

本发明通过融合算法获得当前车辆车速vx、横摆角速度γ、侧偏角β与当前道路附着系数μ,同时针对故障信息识别得到故障情况下的执行器剩余执行能力,计算故障矩阵:The present invention obtains the current vehicle speed v x , yaw rate γ, sideslip angle β and current road adhesion coefficient μ through a fusion algorithm, and simultaneously obtains the remaining execution capacity of the actuator under the fault condition according to the fault information identification, and calculates the fault matrix:

其中,Λ为故障信息矩阵,分别为转向系统和四个车轮驱动/制动系统剩余执行器能力系数,代表剩余执行能力与无故障情况下的执行能力比值;为根据对角元素生成矩阵的函数。Among them, Λ is the fault information matrix, They are the remaining actuator capacity coefficients of the steering system and the four wheel drive/brake systems, representing the ratio of the remaining execution capacity to the execution capacity in the absence of faults; is a function that generates a matrix based on diagonal elements.

针对考虑差动与转向协同横摆稳定控制的车辆动力学进行建模:Modeling vehicle dynamics considering differential and steering coordinated yaw stability control:

式中,x=[βγ]T为横摆稳定控制状态变量向量;A为横摆稳定控制状态转移矩阵;Bv为横摆稳定控制输入矩阵;τ为横摆稳定控制模型的中间控制变量,且τ=Buu;u=[δf TflTfr Trl Trr]T为横摆稳定控制的控制输入向量,δf为前轮转向角,Tij为四轮驱动/制动力转矩命令(ij=fl,fr,rl,rr,分别代表左前,右前,左后,右后车轮);d为横摆稳定控制扰动矩阵;lf和lr分别为车辆前轴到质心距离和后轴到质心距离;R为车辆轮胎有效滚动半径;w为车辆轮距;Cf和Cr分别为车辆前轴与后轴的轮胎侧偏刚度;Iz为车辆的z轴转动惯量,m为整车质量。where x = [βγ] T is the yaw stability control state variable vector; A is the yaw stability control state transfer matrix; Bv is the yaw stability control input matrix; τ is the intermediate control variable of the yaw stability control model, and τ = Buu ; u = [ δf T fl T fr T rl T rr ] T is the control input vector of yaw stability control, δf is the front wheel steering angle, Tij is the four-wheel drive/braking torque command (ij = fl, fr, rl, rr, representing the left front, right front, left rear, and right rear wheels, respectively); d is the yaw stability control disturbance matrix; lf and lr are the distances from the front axle to the center of mass and the distance from the rear axle to the center of mass, respectively; R is the effective rolling radius of the vehicle tire; w is the vehicle wheelbase; Cf and Cr are the tire cornering stiffness of the front and rear axles of the vehicle, respectively; Iz is the z-axis moment of inertia of the vehicle, and m is the vehicle mass.

S2,基于车辆动力学状态信息、故障信息与环境信息并根据上一时刻计算的目标执行命令与实际执行命令的差值矩阵计算约束辅助变量。S2, based on the vehicle dynamics state information, fault information and environmental information and according to the difference matrix between the target execution command calculated at the last moment and the actual execution command, calculate the constraint auxiliary variables.

具体地,基于车辆动力学状态信息、故障信息与环境信息,并通过接受上一时刻的横摆跟踪控制模块的执行命令分配单元计算得到的目标执行命令与实际执行命令差值矩阵计算约束辅助变量α。Specifically, based on the vehicle dynamics state information, fault information and environmental information, and by receiving the target execution command and the actual execution command difference matrix calculated by the execution command allocation unit of the yaw tracking control module at the previous moment Compute the constrained auxiliary variable α.

目标执行命令与实际执行命令差值矩阵可计算为:Difference matrix between target execution command and actual execution command It can be calculated as:

其中,τ为目标执行命令,l(τ)为实际执行命令。Among them, τ is the target execution command, and l(τ) is the actual execution command.

执行约束辅助变量α的微分方程为:The differential equation for implementing the constraint on the auxiliary variable α is:

其中,为执行约束辅助变量α导数;P1与P2为控制目标定义的正定矩阵,需自行设置;Ka为控制参数,需自行设置。in, To execute the constraint, the auxiliary variable α is the derivative; P1 and P2 are the positive definite matrices defined by the control objective, which need to be set by yourself; Ka is the control parameter, which needs to be set by yourself.

通过对于执行约束辅助量导数积分即可得到对应时刻的执行约束辅助变量α。By implementing the constraint auxiliary quantity derivative The execution constraint auxiliary variable α at the corresponding moment can be obtained by integration.

S3,基于径向基函数神经网络对横摆稳定控制扰动矩阵进行观测拟合,以得到横摆稳定控制的扰动矩阵观测值。S3, performing observation fitting on the yaw stability control disturbance matrix based on the radial basis function neural network to obtain the disturbance matrix observation value of the yaw stability control.

具体地,基于径向基函数(RBF)神经网络对横摆稳定控制扰动矩阵d进行观测拟合,得到横摆稳定控制扰动矩阵的观测值扰动矩阵的观测值可以通过下列RBF神经网络进行计算:Specifically, the yaw stability control disturbance matrix d is observed and fitted based on the radial basis function (RBF) neural network to obtain the observed value of the yaw stability control disturbance matrix: Observations of the perturbation matrix It can be calculated by the following RBF neural network:

其中,为RBF神经网络的加权矩阵,在观测估计过程中根据误差进行实时更新;为RBF神经网络的径向基函数,可以选择为高斯函数。in, is the weight matrix of the RBF neural network, which is updated in real time according to the error during the observation and estimation process; is the radial basis function of the RBF neural network, which can be selected as a Gaussian function.

RBF神经网络的加权矩阵更新率设计为:The weighted matrix update rate of the RBF neural network is designed to be:

其中,为RBF神经网络的加权矩阵的导数矩阵;Γ为增益矩阵,需自行设计;加权误差η=(P1+P2)Te+P2a,且e=x-xd为横摆角速度跟踪过程的状态误差;r为增益参数,需自行设计。in, is the derivative matrix of the weighted matrix of the RBF neural network; Γ is the gain matrix, which needs to be designed by yourself; the weighted error η=(P 1 +P 2 ) T e+P 2 a, and e=xx d is the state error of the yaw angular velocity tracking process; r is the gain parameter, which needs to be designed by yourself.

根据计算的加权矩阵的导数对加权矩阵进行积分更新,可以实现对于摆稳定控制扰动矩阵的精确估计。According to the derivative of the weighting matrix calculated Weighted Matrix By performing integral updating, an accurate estimation of the pendulum stabilization control disturbance matrix can be achieved.

S4,基于约束辅助变量和扰动矩阵观测值计算中间控制变量目标值。S4, calculates the target value of the intermediate control variable based on the constrained auxiliary variables and the disturbance matrix observations.

具体地,基于上述步骤计算的执行约束辅助变量α和扰动矩阵观测值可以根据以下公式计算中间控制变量目标值τ:Specifically, based on the execution constraint auxiliary variable α and the disturbance matrix observation value calculated in the above steps The intermediate control variable target value τ can be calculated according to the following formula:

其中,xd=[βdγd]T为横摆稳定控制目标状态,为xd导数;K1、K2为控制增益,需要自行设计。Where x d = [β d γ d ] T is the target state of yaw stability control, is the derivative of xd ; K1 and K2 are control gains, which need to be designed by yourself.

S5,基于执行器执行能力对中间控制变量目标值进行分配,计算执行器执行的控制命令。S5, allocating the target value of the intermediate control variable based on the execution capability of the actuator, and calculating the control command executed by the actuator.

具体地,基于执行器执行能力对中间控制变量目标值τ进行分配,计算执行器执行命令,并计算中间控制变量执行偏差步骤S4中计算的中间控制变量目标值τ可以通过下列优化问题的求解进行分解:Specifically, the intermediate control variable target value τ is allocated based on the actuator execution capability, the actuator execution command is calculated, and the intermediate control variable execution deviation is calculated. The intermediate control variable target value τ calculated in step S4 can be decomposed by solving the following optimization problem:

Cu-δ2=Tacc,Cu-δ 2 =T acc ,

Λumin≤u≤Λumax.Λu min ≤u≤Λu max .

式中,的优化求解值,δ1为第一松弛变量,δ2为第二松弛变量;Wu、Wτ为优化目标的定义矩阵,为优化目标函数的定义参数,均为优化设计参数;C为驱动系数矩阵,C=[01111];umin、umax分别为控制输入的最大值向量和最小值向量;Tacc为维持车速所需的目标整车驱动力矩。In the formula, for The optimized solution value of , δ 1 is the first slack variable, δ 2 is the second slack variable; W u , W τ are the definition matrices of the optimization objective, are the definition parameters of the optimization objective function, all of which are optimization design parameters; C is the drive coefficient matrix, C=[01111]; u min and u max are the maximum value vector and minimum value vector of the control input respectively; T acc is the target vehicle drive torque required to maintain the vehicle speed.

同时,实际执行命令l(τ)=Buu,可计算中间控制变量执行偏差 At the same time, the actual execution command l(τ) = Bu u can calculate the execution deviation of the intermediate control variable

上述优化问题,通过引入松弛变量δ1并设计对应的优化约束条件,可以减少分配过程对于控制李雅普诺夫函数V(e)=eTPe的影响,在车辆剩余执行能力范围内尽可能小的减少因为执行能力不足导致的控制性能恶化,保证横摆稳定控制精度,同时满足车辆车速维持需求。For the above optimization problem, by introducing the slack variable δ 1 and designing the corresponding optimization constraints, the influence of the allocation process on the control of the Lyapunov function V(e) = e T Pe can be reduced, and the deterioration of the control performance caused by insufficient execution capability can be minimized within the remaining execution capability of the vehicle, thereby ensuring the yaw stability control accuracy and meeting the vehicle speed maintenance requirements.

S6,通过执行器执行对应控制命令,其中,四轮驱动/制动力矩中正值由对应执行器的车轮驱动系统执行,负值由执行器的对应车轮制动和驱动系统协调控制,前轮转向角命令由执行器的转向系统执行。S6, execute the corresponding control command through the actuator, wherein the positive value of the four-wheel drive/braking torque is executed by the wheel drive system of the corresponding actuator, the negative value is coordinated and controlled by the corresponding wheel braking and drive system of the actuator, and the front wheel steering angle command is executed by the steering system of the actuator.

具体地,执行器执行对应控制命令,四轮驱动/制动力矩Tij中正值由对应车轮驱动系统执行,负值由对应车轮制动和驱动系统协调控制,前轮转向角命令δf由转向系统执行。Specifically, the actuator executes the corresponding control command, the positive value of the four-wheel drive/braking torque Tij is executed by the corresponding wheel drive system, the negative value is coordinated and controlled by the corresponding wheel braking and drive system, and the front wheel steering angle command δf is executed by the steering system.

综上所述,通过横摆控制器与下层执行命令分配的交互,在执行器故障后、执行能力下降的情况下,在分配层尽可能减少由于执行能力不足导致的横摆稳定控制性能恶化,同时对横摆控制器反馈中间控制变量执行偏差,通过设计约束辅助变量调整横摆控制器的输出,减少横摆控制器与下层执行命令分配的偏差,从而充分利用剩余执行能力,使得差动转向参与横摆控制过程更加安全稳定,满足了故障场景下转向-差动横摆稳定控制的多种性能指标与安全需求。同时该技术也支持自动驾驶技术的发展,确保在关键系统部分或全部失效时,车辆仍能保持基本的操控安全性,推动自动驾驶车辆的广泛应用。In summary, through the interaction between the yaw controller and the lower-level execution command allocation, when the actuator fails and the execution capability decreases, the deterioration of the yaw stability control performance caused by insufficient execution capability is minimized at the allocation layer, and the execution deviation of the intermediate control variable is fed back to the yaw controller. The output of the yaw controller is adjusted by designing constrained auxiliary variables to reduce the deviation between the yaw controller and the lower-level execution command allocation, thereby making full use of the remaining execution capability, making the differential steering participation in the yaw control process safer and more stable, and meeting the various performance indicators and safety requirements of steering-differential yaw stability control under fault scenarios. At the same time, this technology also supports the development of autonomous driving technology, ensuring that the vehicle can still maintain basic control safety when the key system fails partially or completely, and promotes the widespread application of autonomous driving vehicles.

根据本发明实施例的面向执行器失效的转向-差动横摆稳定控制方法,能显著提升车辆在执行器故障时的安全性和稳定性。针对横摆控制器输出执行命令与实际执行的偏差,通过设计约束辅助变量调整横摆控制器的输出,减少横摆控制器与下层执行命令分配的偏差,满足了故障场景下转向-差动横摆稳定控制的多种性能指标与安全需求。The steering-differential yaw stability control method for actuator failure according to the embodiment of the present invention can significantly improve the safety and stability of the vehicle when the actuator fails. In view of the deviation between the output execution command of the yaw controller and the actual execution, the output of the yaw controller is adjusted by designing a constrained auxiliary variable to reduce the deviation between the yaw controller and the lower-level execution command allocation, thereby meeting multiple performance indicators and safety requirements of the steering-differential yaw stability control in the fault scenario.

在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.

此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本发明的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. In the description of the present invention, the meaning of "plurality" is at least two, such as two, three, etc., unless otherwise clearly and specifically defined.

Claims (10)

1. A steering-differential yaw stability control system for an actuator failure, comprising: the system comprises a sensor assembly module, a dynamics fusion observation module, a yaw tracking control module and an execution mechanism subsystem; wherein,
The sensor module is used for outputting vehicle-related sensing information;
the dynamics fusion observation module is used for receiving the vehicle-related sensing information and outputting vehicle dynamics state feedback information and vehicle actuator fault state feedback information;
The yaw tracking control module is used for receiving a yaw tracking angular velocity control command input by a self-driving system or a vehicle driver, calculating the residual execution capacity of an actuator according to the received fault state feedback information of the actuator of the vehicle, simultaneously carrying out yaw tracking stability control feedback control according to the received dynamic state feedback information of the vehicle, and outputting a control command for an actuator subsystem.
2. The system of claim 1, wherein the yaw tracking control module comprises:
an execution constraint assisting unit for calculating a constraint assisting variable to assist yaw stability control based on a difference between the target execution command and the actual execution command;
The disturbance observation unit is used for calculating an observation value of the yaw stability control disturbance matrix;
A yaw stability control unit for calculating a control variable target value of yaw stability control based on the observed values of the constraint auxiliary variable and the disturbance matrix and according to the yaw control target and the vehicle dynamics state feedback information;
And the execution command distribution unit is used for performing actuator distribution on the control variable target value generated by the yaw stability control unit so as to generate front wheel steering angle, a braking system and a driving system control command.
3. The system of claim 2, wherein the system further comprises a controller configured to control the controller,
The execution constraint auxiliary unit is used for receiving the difference value between the target execution command and the actual execution command calculated by the execution command distribution unit at the previous moment, constructing a calculation constraint auxiliary variable based on the difference value, and sending the constraint auxiliary variable to the yaw stability control unit;
The disturbance observation unit is used for carrying out disturbance observation through a yaw control target of the input system and a vehicle dynamics state feedback state difference value, carrying out observation fitting on yaw stability control disturbance by adopting a radial basis function neural network, and sending a fitted disturbance matrix observation value to the yaw stability control unit for feedforward control;
the yaw stability control unit is used for receiving the constraint auxiliary variable and the disturbance matrix observation value, performing feedback control according to a yaw control target of the input system and a dynamic state feedback state difference value, and calculating an intermediate control variable of yaw stability control; when the constraint auxiliary variable is not zero, adjusting the output of the intermediate control variable according to the constraint auxiliary variable and outputting the output to the execution command distribution unit;
the execution command distribution unit is used for receiving the input of the intermediate control variable, and carrying out the distribution of the executor command by combining the residual execution capacity of the executor and the whole vehicle driving requirement so as to generate an execution command of the execution mechanism subsystem and calculate an execution distribution error.
4. The system of claim 3, wherein the sensor assembly comprises a plurality of lidar, camera assemblies, GPS, IMU; the actuator subsystem includes: a four-wheel independent braking wire control system, a four-wheel independent driving wire control driving system and a wire control steering system; the dynamics fusion observation module comprises a fault identification unit and a dynamics state identification unit; wherein,
The dynamics fusion observation module receives vehicle-related sensing information output by the sensor assembly module and actuator sensing feedback information fed back by the actuator subsystem; and respectively carrying out fusion calculation on the vehicle-related sensing information and the actuating mechanism sensing feedback information through a fault recognition unit and a dynamics state recognition unit to obtain corresponding vehicle actuator fault state feedback information and vehicle dynamics state feedback information, and transmitting the corresponding vehicle actuator fault state feedback information and the corresponding vehicle dynamics state feedback information to a yaw tracking control module.
5. A steering-differential yaw stability control method for actuator failure is characterized in that,
Acquiring vehicle dynamics state information, fault information and environment information;
Calculating constraint auxiliary variables based on the vehicle dynamics state information, fault information and environment information and according to a difference matrix of the target execution command and the actual execution command calculated at the previous moment;
performing observation fitting on the yaw stability control disturbance matrix based on the radial basis function neural network to obtain a disturbance matrix observation value of yaw stability control;
Calculating an intermediate control variable target value based on the constraint auxiliary variable and the disturbance matrix observation value;
Distributing the intermediate control variable target value based on the execution capacity of the executor, and calculating a control command executed by the executor;
The corresponding control command is executed by the actuator, wherein a positive value in the four-wheel drive/braking torque is executed by the wheel drive system of the corresponding actuator, the corresponding wheel braking and drive system of the actuator is coordinated and controlled, and the front wheel steering angle command is executed by the steering system of the actuator.
6. The method of claim 5, wherein after acquiring the vehicle dynamics state information, the malfunction information, and the environment information, the method further comprises:
The vehicle dynamics state information, the fault information and the environment information are fused through a fusion algorithm to obtain a current vehicle speed v x, a yaw rate gamma, a slip angle beta and a current road attachment coefficient mu, and the residual execution capacity of the actuator under the fault condition is obtained through recognition based on the fault information to calculate a fault matrix;
Wherein, lambda is the fault information matrix, The residual actuator capacity coefficients of the steering system and the four wheel driving/braking systems represent the residual actuator capacity and the actuator capacity ratio value under the fault-free condition; generating a function of the matrix for the diagonal elements;
Modeling based on vehicle dynamics of differential and steering cooperative yaw stability control:
Wherein x= [ βγ ] T is a yaw stability control state variable vector; a is a yaw stability control state transition matrix; b v is a yaw stability control input matrix; τ is an intermediate control variable of the yaw stability control model, τ=b uu;u=[δf Tfl TfrTrl Trr]T is a control input vector of the yaw stability control, δ f is a front wheel steering angle, and T ij is a four wheel drive/braking force torque command; ij=fl, fr, rl, rr, respectively representing front left, front right, rear left, rear right wheels; d is a yaw stability control disturbance matrix; l f and l r are the front axle to centroid distance and rear axle to centroid distance, respectively, of the vehicle; r is the effective rolling radius of the vehicle tyre; w is the track of the vehicle; c f and C r are the tire cornering stiffness of the front and rear axles of the vehicle, respectively; i z is the z-axis moment of inertia of the vehicle, and m is the mass of the whole vehicle.
7. The method according to claim 6, wherein the difference matrix between the target execution command and the actual execution command calculated at the previous time is calculatedCalculating a constraint auxiliary variable α, comprising:
Difference matrix of target execution command and actual execution command
Wherein τ is a target execution command, and l (τ) is an actual execution command;
The differential equation for the execution constraint auxiliary variable α is:
wherein, To perform constraint on the auxiliary variable alpha derivative; p 1 and P 2 are positive definite matrixes defined by control targets, and K a is a control parameter.
8. The method of claim 7, wherein the yaw stability control disturbance matrix d is fitted by observation based on a radial basis function neural network to obtain a disturbance matrix observation of yaw stability controlComprising the following steps:
wherein, A weighting matrix for the RBF neural network; radial basis functions of the RBF neural network;
The update rate of the weighting matrix of the RBF neural network is as follows:
wherein, A derivative matrix that is a weighting matrix of the RBF neural network; Γ is the gain matrix; the weighting error η= (P 1+P2)Te+P2 a, and e=x-x d is the state error of the yaw-rate tracking process, r is the gain parameter.
9. The method of claim 8, wherein the constraint-based auxiliary variable α and the perturbation matrix observations are based onCalculating an intermediate control variable target value τ, comprising:
Wherein x d=[βdγd]T is the yaw stability control target state, Is x d derivative; k 1、K2 is the control gain.
10. The method according to claim 9, characterized in that the intermediate control variable target value τ is decomposed by solving the following optimization problem:
Cu-δ2=Tacc,
Λumin≤u≤Λumax.
wherein, Is thatDelta 1 is a first relaxation variable and delta 2 is a second relaxation variable; w u、Wτ is a defined matrix of optimization objectives,The definition parameters for optimizing the objective function are all optimization design parameters; c is a driving coefficient matrix, C= [01111];
u min、umax is the maximum value vector and minimum value vector of the control input respectively; t acc is the target whole vehicle driving torque required for maintaining the vehicle speed;
Actual execution command l (τ) =b u u, calculate intermediate control variable execution bias
CN202411220616.XA 2024-09-02 2024-09-02 A Steering-Differential Yaw Stability Control Method for Actuator Failure Pending CN118810829A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202411220616.XA CN118810829A (en) 2024-09-02 2024-09-02 A Steering-Differential Yaw Stability Control Method for Actuator Failure

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202411220616.XA CN118810829A (en) 2024-09-02 2024-09-02 A Steering-Differential Yaw Stability Control Method for Actuator Failure

Publications (1)

Publication Number Publication Date
CN118810829A true CN118810829A (en) 2024-10-22

Family

ID=93082237

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202411220616.XA Pending CN118810829A (en) 2024-09-02 2024-09-02 A Steering-Differential Yaw Stability Control Method for Actuator Failure

Country Status (1)

Country Link
CN (1) CN118810829A (en)

Similar Documents

Publication Publication Date Title
US12017642B2 (en) Method and apparatus for front and rear driving torque distribution of vehicle, and vehicle
CN109733205B (en) Direct yaw moment control method for hub electric vehicle with fault-tolerant function
US10597028B2 (en) Systems and methods for holistic vehicle control with collaborative steering, electronic limited slip differential (ELSD), powertrain and braking
JP4059194B2 (en) Integrated control system for vehicles
WO2022266824A1 (en) Steering control method and apparatus
CN115837843B (en) A direct yaw torque coordinated steering control method for distributed drive electric vehicles
CN113009829B (en) A vertical and horizontal coupling control method for intelligent networked fleet
WO2025044775A1 (en) Fault-tolerant actuator control method and apparatus for electric vehicle, storage medium, and vehicle
JP2023035900A (en) Vehicle control based on dynamically configured sideslip limit
CN114954432A (en) A collaborative control method for vehicle path tracking and vehicle body attitude
EP4396063B1 (en) Vehicle control for simplified autonomous drive
Wang et al. Fault tolerant control of 4-wheel independent drive vehicle subject to actuator faults based on feasible region
Huang et al. Torque fault-tolerant hierarchical control of 4wid electric vehicles based on improved MPC and SMC
CN117864161A (en) Cloud-based intelligent network-connected automobile control system and method
CN119459339B (en) Distributed driving electric vehicle fault lameness maneuver enhancement control method and system
CN118810829A (en) A Steering-Differential Yaw Stability Control Method for Actuator Failure
CN118418981A (en) Electric vehicle lateral stability coordinated control method, device and storage medium
CN118439007A (en) Steering-differential path tracking control method for actuator failure
CN118618399A (en) Secondary motion planning method and system for intelligent vehicle actuator failure
CN117885702A (en) EMB braking deviation control and braking error correction method, device, equipment and medium
Zhang et al. Cooperative Trajectory Tracking and Stability Control with Improved Stability Criterion for Intelligent Four-Wheel-Independent-Drive Electric Vehicles
Luo et al. A control allocation strategy of multi-axle unmanned distributed drive vehicle
Vera et al. Fault tolerant longitudinal control of an over-actuated off-road vehicle
JP2022110870A (en) Control device and control system
CN120756504A (en) A distributed drive vehicle preset performance fault-tolerant control method and system based on adaptive neural network observer

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