CN110341714B - 一种同时估计车辆质心侧偏角和扰动的方法 - Google Patents

Abstract

本发明公开了一种同时估计车辆质心侧偏角和扰动的方法，属于车辆控制领域。主要步骤为：1、利用方向盘转角传感器、横摆角速度传感器和速度传感器分别检测车辆运行过程中的前轮转角δ、横摆角速度ω和纵向轮速v_x；2、设计能同时估计车辆质心侧偏角和扰动的观测器，包括：步骤2.1：建立包含扰动的二自由度车辆系统动力学模型；步骤2.2：利用车辆动力学模型设计观测器；3、将步骤1检测的车辆状态信息传递到步骤2设计的观测器，同时运算估计得出质心侧偏角和扰动。本发明的主要优点是设计的观测器能实现对车辆质心侧偏角和扰动的同时估计。

Description

一种同时估计车辆质心侧偏角和扰动的方法

技术领域

本发明涉及车辆控制领域，具体地说是一种基于软件离线编程，构造观测器，实现对车辆控制系统中质心侧偏角和扰动的同时估计方法。

背景技术

近年来，随着社会和经济的增长，人们生活水平有了极大提高，全球汽车保有量也不断上升。作为现代社会的一种重要交通工具，汽车的普及给人们的工作和生活带来了极大方便，但同时也引发了一些严重的社会问题，其中车辆的行驶安全问题已成为全球性的社会问题。

由于汽车行驶工况的复杂性，为提高车辆行驶时的主动安全性能，一系列车辆主动安全控制系统，如防抱死制动系统、牵引力控制系统、车身电子稳定系统等应运而生。这些主动安全控制系统能有效提高车辆的操纵稳定性，避免交通事故的发生。然而，这些系统的实现均依赖于对车辆质心侧偏角的准确估计。另一方面，外部扰动也往往会影响车辆系统的稳定性。

然而，由于测量车辆质心侧偏角和外部扰动的传感器价格十分昂贵，且信号的可靠性问题也尚未完全解决，使得这些信息目前在实际车辆系统中很难直接通过传感器测量获得。因此，如何利用车辆现有的各种传感器所测量得到的信息来较为准确地估计车辆质心侧偏角和外部扰动是车辆主动安全系统研究中的重要内容，得到了众多国内外研究者的关注。

目前已有一些车辆质心侧偏角的估计方法，但都存在着一些不足。如申请号为201610224498.9的专利“一种基于二阶滑模观测器的车辆质心侧偏角的估计方法”，虽然对车辆系统进行了质心侧偏角的估计，但并未考虑对扰动的估计。因此，本发明基于一种新型观测器，提出了一种能同时估计车辆质心侧偏角和扰动的方法。

发明内容

本发明的目的是提出一种同时估计车辆质心侧偏角和扰动的方法，利用其鲁棒性强的特点以一种低成本的方式同时精确估计车辆系统的质心侧偏角和扰动。实现本发明的技术方案如下：

一种同时估计车辆质心侧偏角和扰动的方法，包括以下步骤：

步骤1、利用方向盘转角传感器、横摆角速度传感器和速度传感器分别检测车辆运行过程中的前轮转角u、横摆角速度ω和纵向轮速v_x；

步骤2、设计能同时估计车辆质心侧偏角和扰动的观测器，包括：

步骤2.1，建立包含扰动的二自由度车辆系统动力学模型；

步骤2.2，利用车辆动力学模型设计观测器；

步骤3、将步骤1检测的车辆状态信息传递到步骤2设计的观测器，同时运算估计得出质心侧偏角和扰动。

为了实现上述目的，本发明采用如下技术方案：

进一步地，所述步骤2.1中包含不确定因素的二自由度车辆系统动力学模型被建立如下：

其中，ΔA₁₁、ΔA₁₂、ΔB₁、ΔA₂₁、ΔA₂₂、ΔB₂分别为A₁₁、A₁₂、B₁、A₂₁、A₂₂、B₂的不确定因素，

m为汽车质量，K_f为前轴侧偏刚度，K_r为后轴侧偏刚度，I_z为整车绕z轴的转动惯量，x表示纵向运动，y表示横向运动，a为车辆前轴到质心的距离，b为车辆后轴到质心的距离，v_x为纵向速度，v_y为横向速度，ω为车辆的横摆角速度，β为质心侧偏角；u为车辆的前轮转角。

分离上述的车辆系统动力学模型的不确定项部分，得到

式中，d₁(t)＝ΔA₁₁·ω+ΔA₁₂·β+ΔB₁·u，d₂(t)＝ΔA₂₁·ω+ΔA₂₂·β+ΔB₂·u。

将d(t)＝d₁(t)＝d₂(t)作为扰动项，并结合车辆动力学模型有：

进一步地，所述步骤2.2中能同时估计质心侧偏角和扰动的观测器，其构造如下：

其中，

和

分别是β和d(t)的估计值，s＝ω，z₁和z₂满足如下关系：

P₁(s)和P₂(s)是待设计的观测器动态参数。

进一步地，所述步骤2.2中设计观测器动态参数的选取准则如下：

令

ε＝(ε₁,ε₂)^T，

则

因此，得到以下系统：

因此，可以选择合适的动态参数P₁(s)和P₂(s)使得上述系统稳定。

本发明具有的有益效果在于：

(1)本发明设计的观测器是基于二自由度车辆动力学模型建立起来的，与完整的七自由度车辆模型相比，二自由度模型具有较弱的非线性以及耦合关系。此外，基于七自由度模型设计的质心侧偏角观测器很难实现且运算量大，因而难以保证观测器所需的动态品质。而本发明所采用的二自由度模型针对车辆质心侧偏角进行了模型简化，更便于列写关于质心侧偏角的状态方程，便于观测器设计。

(2)由于车辆行驶工况的复杂性，必然需给车辆配备主动安全控制系统。但此系统的实现依赖于对车辆质心侧偏角的准确估计。此外，外部扰动也往往会影响车辆系统的稳定性。单纯依靠传感器来测量车辆质心侧偏角和外部扰动，往往成本高但可靠性低。目前已有一些车辆质心侧偏角和外部扰动的估计方法，但这些方法都只是单一地估计车辆质心侧偏角或外部扰动，并不能同时估计车辆质心侧偏角和扰动。这必然会对车辆安全行驶造成一定的影响。而本发明能实现对车辆质心侧偏角和扰动的同时观测，成本低而可靠性高。

(3)实际使用时，只需要3个简易廉价的传感器，操作简便、实时性和实用性较好。

附图说明

图1是本发明的系统结构框图；

图2是本发明中车辆动力学模型示意图；

图3是本发明中车辆前轮转角输入曲线图；

图4是本发明中车辆质心侧偏角的观测图；

图5是本发明中车辆系统扰动观测图。

具体实施方式

本发明提供了一种同时估计车辆质心侧偏角和扰动的方法。为使本发明的目的、技术方案及效果更加清楚、明确，以下将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整的描述。应当理解的是，此处描述的具体实施例仅用以解释本发明，并不用于限定本发明。

本发明是基于车身电子稳定系统所用的常规传感器如测速传感器、横摆角速度传感器、方向盘转角传感器等设计的，需要通过这些传感器测量车辆运行状态作为观测器模块的输入信号以同时估计车辆质心侧偏角和扰动。

图1所示是本发明的质心侧偏角和扰动估计的系统结构框图，它包括纵向速度传感器、横摆角速度传感器、前轮转角传感器、车辆动力学数学模型、观测器。利用车辆动力学数学模型建立观测器，然后根据纵向速度传感器、横摆角速度传感器以及前轮转角传感器分别测得车辆纵向速度v_x、横摆角速度ω、前轮转角u信息，利用观测器同时得到车辆质心侧偏角的估计值和扰动的估计值。

下面通过具体实施来解释本发明对行驶过程中的车辆质心侧偏角和扰动的估计方法：

步骤1：利用方向盘转角传感器、横摆角速度传感器和速度传感器分别检测车辆运行过程中的前轮转角u、横摆角速度ω和纵向轮速v_x。

步骤2：设计能同时估计车辆质心侧偏角和扰动的观测器。

车辆系统的二自由度动力学模型的示意图如图2所示，x表示纵向运动，y表示横向运动，a为车辆前轴到质心的距离，b为车辆后轴到质心的距离，v_x为纵向速度，v_y为横向速度，ω为车辆的横摆角速度，β为质心侧偏角，u为车辆的前轮转角，F_xf、F_yf、F_xr、F_yr分别表示前轮纵向力、前轮横向力、后轮纵向力、后轮横向力。

结合图2，包含不确定因素的二自由度车辆系统动力学模型被建立如下：

其中，ΔA₁₁、ΔA₁₂、ΔB₁、ΔA₂₁、ΔA₂₂、ΔB₂分别为A₁₁、A₁₂、B₁、A₂₁、A₂₂、B₂的不确定因素，

m为汽车质量，K_f为前轴侧偏刚度，K_r为后轴侧偏刚度，I_z为整车绕z轴的转动惯量。

分离上述的车辆系统动力学模型的不确定项部分，得到

式中，d₁(t)＝ΔA₁₁·ω+ΔA₁₂·β+ΔB₁·u，d₂(t)＝ΔA₂₁·ω+ΔA₂₂·β+ΔB₂·u。

将d(t)＝d₁(t)＝d₂(t)作为扰动项，并结合车辆动力学模型有：

然后，根据车辆动力学模型(3)，所设计的观测器为

其中，

和

分别是β和d(t)的估计值，s＝ω，z₁和z₂满足如下关系：

P₁(s)和P₂(s)是待设计的观测器动态参数。

接下来分析此观测器是如何同时观测出车辆质心侧偏角和扰动。

首先，令

ε＝(ε₁,ε₂)^T，

进一步地，对ε₁进行求导得：

同时，对ε₂也进行求导得：

进一步地，将(6)式和(7)式结合得

因此，只需选择合适的动态参数P₁(s)和P₂(s)便能使系统(8)稳定。从而，实现同时观测出车辆质心侧偏角和扰动。

步骤3：将步骤1检测的车辆状态信息传递到步骤2设计的观测器，同时运算估计得出质心侧偏角和扰动。

前面两个步骤已经检测到了车辆的状态信号，并推导得到观测器的基本结构。步骤3主要是将方向盘转角传感器、横摆角速度传感器和速度传感器检测到的车辆状态信号传递到观测器中。观测器根据车辆实时的前轮转角u、横摆角速度ω和纵向轮速v_x，采用步骤2推导得到的公式(4)进行运算即可同时得到车辆质心侧偏角的估计值

和扰动的估计值

本发明实施例中采用的车辆参数如表1所示，选择的动态参数P₁(s)＝2s和P₂(s)＝350s，选取的试验工况为纵向速度v_x＝20m/s，假设给定以下形式的扰动：

并且车辆以图3所示的前轮转角u蛇形前进进行MATLAB仿真实验。

表1示例车辆参数

名称	符号	值(单位)
			车辆质量	m	1464kg
转动惯量	I<sub>z</sub>	1523kg.m<sup>2</sup>
			车辆前轴到质心的距离	a	1.256m
车辆后轴到质心的距离	b	1.368m
			前轴侧偏刚度	K<sub>f</sub>	25575
后轴侧偏刚度	K<sub>r</sub>	29203

在本发明实例的仿真试验下，观测器的观测反馈曲线如图4和图5所示。由图4和图5得出本发明设计的观测器观测误差很小，能同时实现对车辆质心侧偏角和扰动的快速精确观测。

在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。

尽管已经示出和描述了本发明的实施例，本领域的普通技术人员可以理解：在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由权利要求及其等同物限定。

Claims (4)

1.一种同时估计车辆质心侧偏角和扰动的方法，其特征在于，包括以下步骤：

步骤1、利用方向盘转角传感器、横摆角速度传感器和速度传感器分别检测车辆运行过程中的前轮转角u、横摆角速度ω和纵向速度v_x；

步骤2、设计能同时估计车辆质心侧偏角和扰动的观测器，包括：

步骤2.1，建立包含不确定因素的二自由度车辆系统动力学模型；

步骤2.2，利用车辆系统动力学模型设计观测器；

步骤3、将步骤1检测的前轮转角u、横摆角速度ω和纵向速度v_x传递到步骤2设计的观测器，同时运算估计得出质心侧偏角和扰动；

步骤2.1中，包含不确定因素的二自由度车辆系统动力学模型为：

其中，ΔA₁₁、ΔA₁₂、ΔB₁、ΔA₂₁、ΔA₂₂、ΔB₂分别为A₁₁、A₁₂、B₁、A₂₁、A₂₂、B₂的不确定因素，

m为汽车质量，K_f为前轴侧偏刚度，K_r为后轴侧偏刚度，I_z为整车绕z轴的转动惯量，x表示纵向运动，y表示横向运动，a为车辆前轴到质心的距离，b为车辆后轴到质心的距离，v_x为纵向速度，v_y为横向速度，ω为车辆的横摆角速度，β为质心侧偏角，u为车辆的前轮转角；

分离上述的车辆系统动力学模型的不确定项部分，得到

式中，d₁(t)＝ΔA₁₁·ω+ΔA₁₂·β+ΔB₁·u，d₂(t)＝ΔA₂₁·ω+ΔA₂₂·β+ΔB₂·u；

将d(t)＝d₁(t)＝d₂(t)作为扰动项，并结合车辆系统动力学模型有：

步骤2.2中，利用车辆系统动力学模型设计观测器为：

其中，

和

分别是β和d(t)的估计值，s＝ω，z₁和z₂满足如下关系：

P₁(s)和P₂(s)是待设计的观测器动态参数。

2.根据权利要求1所述的一种同时估计车辆质心侧偏角和扰动的方法，其特征在于，步骤2.2中，设计观测器动态参数的选取准则是：选择合适的动态参数P₁(s)和P₂(s)使得以下系统稳定：

其中，ε＝(ε₁,ε₂)^T,

3.根据权利要求1所述的一种同时估计车辆质心侧偏角和扰动的方法，其特征在于，动态参数P₁(s)＝2s和P₂(s)＝350s。

4.根据权利要求3所述的一种同时估计车辆质心侧偏角和扰动的方法，其特征在于，选取的试验工况为纵向速度v_x＝20m/s，扰动为：

Images