首页 / 专利库 / 电气和电子设备 / 轮速传感器 / 无人驾驶独立驱动和转向车辆整车动力学控制量获得方法

无人驾驶独立驱动和转向车辆整车动学控制量获得方法

阅读:994发布:2021-11-01

专利汇可以提供无人驾驶独立驱动和转向车辆整车动学控制量获得方法专利检索,专利查询,专利分析的服务。并且本 发明 涉及一种无人驾驶独立驱动和转向车辆整车动 力 学控制量获得方法,该方法在获取车辆-道路 跟踪 系统信息的 基础 上,计算整车动力学控制量可达域,据此对系统跟踪期望偏差进行调整,对最终获得的整车动力学控制量的可行性加以判断、处理,同时还实时估计并利用了系统扰动信息,从而提高计算获得的车辆整车动力学控制量的有效性、合理性和鲁棒性能,使无人驾驶AWID-AWIS车辆能够在低附着系数路面、分离路面上以更好的 精度 、更高的速度跟踪 曲率 更大的道路路径,车辆动力学控制效果理想,行驶安全。,下面是无人驾驶独立驱动和转向车辆整车动学控制量获得方法专利的具体信息内容。

1.一种无人驾驶独立驱动和转向车辆整车动学控制量获得方法,其特征在于,包括以下步骤:
1)估计车辆质量转动惯量,采集车辆-道路跟踪系统中与车辆质心对应的实际车速、横向距离偏差和横摆偏差数据,以及用于车辆-道路跟踪的车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶全轮独立驱动-独立转向车辆整车动力学控制所需的系统状态信息数据{X};
2)根据步骤1)获取的系统状态信息数据,利用有约束几何映射法计算整车动力学控制量可达域;
3)根据步骤1)获取的系统状态信息数据及步骤2)获取的整车动力学控制量可达域信息数据,计算系统跟踪期望偏差;
4)利用无人驾驶全轮独立驱动-独立转向车辆-道路跟踪系统动力学模型和步骤3)生成的系统跟踪期望偏差,结合步骤1)获取的系统状态信息数据,采用带扰动实时估计的鲁棒控制方法生成整车动力学备选控制量,该整车动力学备选控制量由总纵向力备选控制量、总侧向力备选控制量、总横摆力矩备选控制量构成;
5)结合步骤2)获得的整车动力学控制量可达域,对步骤4)生成的整车动力学备选控制量的可行性进行判断和调整,获得整车动力学控制量,即总纵向力控制量、总侧向力控制量、总横摆力矩控制量。
2.根据权利要求1所述的无人驾驶独立驱动和转向车辆整车动力学控制量获得方法,其特征在于:
1.1)所述步骤1)中估计车辆质量和转动惯量,具体为利用无人驾驶全轮独立驱动-独立转向车辆标称质量mn和标称转动惯量Izn,获取车辆质量估计值mest=mn、转动惯量估计值Izest=Izn;
1.2)所述步骤1)中采集车辆-道路跟踪系统中与车辆质心对应的实际车速、横向距离偏差和横摆角偏差数据,具体为利用GIS+DGPS,或车载式车道线视觉检测系统,或道路磁钉检测系统,采集车道当前跟踪点PC处的横向距离偏差,以及车辆纵轴在道路平面上的垂直投影线同车道当前跟踪点PC处车道中心线切线之间的横摆角偏差Δψ;其中,PC为过车辆质心并沿垂直于车辆纵轴方向的平面与车道中心线的交点,Δy为车辆质心与PC点线段在道路平面上的投影线长度;
1.3)所述步骤1)中采集用于车辆-道路跟踪的车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶全轮独立驱动-独立转向车辆整车动力学控制所需的系统状态信息数据,具体为利用GIS+DGPS,或车载式车道线视觉检测系统,或道路磁钉检测系统,获取车道当前跟踪点PC处的道路中心线曲率ρPC,利用轮速传感器、GPS、垂直陀螺仪采集车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶全轮独立驱动-独立转向车辆整车动力学控制所需的车速vx和系统附加状态信息数据{X}0,所述系统附加状态信息数据{X}0包括车辆纵向加速度、侧向加速度、俯仰角、侧倾角、质心侧偏角和横摆角速率数据,以及车道当前跟踪点PC处的道路中心线曲率ρPC;
1.4)所述步骤1)中系统状态信息数据{X}由系统基本状态信息数据
{mest,Izest,vx,Δy,Δψ}与系统附加状态信息数据{X}0的并集构成。
3.根据权利要求2所述的无人驾驶独立驱动和转向车辆整车动力学控制量获得方法,其特征在于:所述步骤2)中根据步骤1)获取的系统状态信息数据,利用有约束几何映射法计算整车动力学控制量可达域,具体包括:
2.1)整车动力学控制量可达域计算模型表达式为:
所述表达式(1)~(4)的含义是已知u和B,求v;式中v为整车动力学控制量可达域,是一个由总纵向力控制量Fx、总侧向力控制量Fy、总横摆力矩控制量Mz构成的三维有界函数空间区域;效率矩阵B根据步骤1)获取的系统状态信息数据{X}、车轮转角、车辆底盘几何参数确定;u为2m维的车轮控制量,由m个车轮纵向力和m个侧向力构成;
为第j个车轮的允许制动力或驱动力的下界、上界,j=1,2,…,m,m为大于等于3的正整数; 为第j个车轮的允许侧向力的下界、上界;Fmaxj为第j个车轮的允许轮胎
力总力;Fxj、Fyj为第j个车轮纵向力控制量、侧向力控制量;
2.2) 求 每 个 车 轮 的 线 性 约 束 条 件 式 (3) ~ (4) 的 交 集
为 第 j 个 车 轮
控制量线性约束域,以及每个车轮的非线性约束条件式(2) ~(4)的交集
为第j个车轮控制
量非线性约束域,j=1,2,…,m,m为大于等于3的正整数;
2.2.1)计算整车动力学控制量可达域v:如果 则直接
以 为约束条件计算v;如果 则首先使用二等分角逼近法
求每个车轮控制量非线性约束域 的矩形逼近序列集合 其中
为第j个车轮
控制量非线性约束域 的第s个逼近矩形的纵向力的上、下界, 为其侧向
力的上、下界,s=1,2,…,p0,p0根据计算精度要求确定,j=1,2,…,m,m为大于等于3的正整数,则整车动力学控制量可达域计算模型表达为式(1)和式(5)~(6),然后再计算每s s
个 对应的控制量可达域子域v,s=1,2,…,p0,取所有v 的并集作为整车动力学控制量可达域v,
步骤2.1)、2.2)、2.2.1)描述的方法称为有约束几何映射法;
2.2.1.1)步骤2.2.1)中p0根据计算精度要求确定,具体为记第s个逼近矩形的面积为Ss,记允许逼近误差ε=0.05,按如下步骤计算p0:
第一步:p0赋初值1,即p0=1,计算非线性约束域 的面积,记为S;
第二步:计算第p0个逼近矩形的面积Sp0;
第三步:计算从第1个到第p0个逼近矩形的面积之和 判断 是否成
立,若成立,p0值计算结束;若不成立,执行第四步;
第四步:p0加1,转第二步。
4.根据权利要求3所述的无人驾驶独立驱动和转向车辆整车动力学控制量获得方法,其特征在于:所述步骤3)中根据步骤1)获取的系统状态信息数据和步骤2)获取的整车动力学控制量可达域信息,计算系统跟踪期望偏差具体方法如下:
3.1)设定整车动力学控制目标期望值的初始值:期望车速 期望距离偏差Δyd=0,期望横摆角偏差Δψd=0,计算其与步骤1)获取的vx、Δy、Δψ之间的系统跟踪期望偏差初始值: 依据车道当前跟踪点PC处的道路中心
线曲率 、车辆最大侧向加速度约束aymax确定,如式(7):
3.2)根据步骤2)获取的整车动力学控制量可达域v,利用一组专家规则即规则1、规则
2、…、规则n,n为大于等于3的正整数,对步骤3.1)获取的 和 进行调整,
规则1:如果v较大,而 和 的绝对值都较小,则无需对 和 进行调
整,系统跟踪期望偏差
规则2:如果v较小,而 和 的绝对值都为中等大小,则使用式(8)~(10)对
和 进行调整,得到系统跟踪期望偏差evxd、eΔy和eΔψ:
Ts为车辆-道路跟踪系统控制周期; 为时间常数,根据专家经验确定,
取作Ts的2.5倍;

规则n:如果v较小,而 和 的绝对值都较大,则使用式(11)~(13)对
和 进行调整,得到系统跟踪期望偏差evxd、eΔy和eΔψ:
为时间常数,根据专家经验确定,取作Ts的5.0倍;
3.2.1)步骤3.2)中的“较小”、“中等大小”、“较大”为模糊隶属度取值,利用基于专家经验的模糊逻辑方法确定,正整数n根据v、 和 四个变量模糊子域的划分和具体
采用的模糊推理方法确定;规则3~规则n-1的设计与上述方法类似。
5.根据权利要求4所述的无人驾驶独立驱动和转向车辆整车动力学控制量获得方法,其特征在于:所述步骤4)中利用无人驾驶全轮独立驱动-独立转向车辆-道路跟踪系统动力学模型和步骤1)获取的系统状态信息数据、步骤3)生成的系统跟踪期望偏差,采用带扰动实时估计的鲁棒控制方法生成整车动力学备选控制量,具体包括:
4.1)全轮独立驱动-独立转向车辆整车动力学模型表达式为:
式中 分别为vx、Δy、Δψ的一阶和二阶导数;mest为车辆质量估计值,
Izest为转动惯量估计值;Fx为总纵向力控制量、Fy为总侧向力控制量、Mz为总横摆力矩控制量;fvx、fΔy和fΔψ分别为无人驾驶全轮独立驱动-独立转向车辆-跟踪系统纵向、横向和横摆运动三个动力学通道“内扰+外扰”的“总和”;
4.2)使用带“内扰”和“外扰”估计功能的ADRC鲁棒控制器计算整车动力学备选控制量:
4.2.1)采用式(17)所示的二阶离散扩张状态观测器对fvx进行实时估计,采用式(18)所示的三阶离散扩张状态观测器对fΔy和fΔψ分别进行实时估计;
式(17)和式(18)中,k代表当前控制步,h为控制周期;y(k)代表vx、Δy或Δψ的第k步测量值;z1(k)代表vx、Δy或Δψ的第k步估计值;e为vx、Δy或Δψ第k步测量值y(k)和估计值z1(k)之间的偏差;β01、β02、β03、α1、α2、δ0为控制器参数;fal(e,α1,δ0)、fal(e,α2,δ0)分别由表达式(19-1)、(19-2)表达,sign(e)表示e的符号函数;式(17)中,z2(k)代表fvx的估计值,b0=1/mest,u(k)=FxC(k),即第k步总纵向力备选控制量FxC(k);
式(18)中,z2(k)代表Δy或Δψ一阶导数的估计值,z3(k)代表fΔy或fΔψ的估计值,b0=-1/mest,对应fΔy估计,或b0=-1/Izest,对应fΔψ估计,u(k)=FyC(k)或u(k)=MzC(k),即第k步总侧向力备选控制量FyC(k)或总横摆力矩备选控制量MzC(k);
4.2.2)计算整车动力学备选控制量:采用式(20)所示的一阶离散非线性比例控制器对fvx进行实时补偿,采用式(21)所示的二阶离散非线性比例控制器对fΔy和fΔψ分别进行实时补偿,对各通道误差进行反馈校正;
式(20)和式(21)中,fal(e1,αp,δp)、fal(e2,αd,δd)由式(22-1)、式(22-2)分别表达;KP、Kd、αP、δP、αd、δd为控制器参数,u0为中间变量;式(20)中,e1是evxd的跟踪信号,b0、u(k)、z2(k)意义同式(17);式(21)中,e1是eΔy或eΔψ的跟踪信号,e2是eΔy或eΔψ的跟踪微分信号,b0、u(k)、z3(k)意义同式(18);无人驾驶全轮独立驱动-独立转向车辆整车动力学备选控制量是一个3维矢量,记为UC,UC=[FxC FyC MzC]T,第k步值UC(k)=[FxC(k) FyC(k) MzC(k)]T,T为转置符号;
步骤4.1)、4.2)、4.2.1)、4.2.2)描述的方法称为无人驾驶全轮独立驱动-独立转向车辆-道路跟踪系统整车动力学备选控制量计算的带扰动实时估计的鲁棒控制方法。
6.根据权利要求5所述的无人驾驶独立驱动和转向车辆整车动力学控制量获得方法,其特征在于:所述步骤5)中结合步骤2)获得的整车动力学控制量可达域,对步骤4)生成的整车动力学备选控制量的可行性进行判断和调整,获得整车动力学控制量,即总纵向力控制量、总侧向力控制量、总横摆力矩控制量,具体包括:
5.1)记Fx(k)、Fy(k)、Mz(k)分别为总纵向力控制量Fx、总侧向力控制量Fy、总横摆力矩T
控制量Mz的第k步值,整车动力学控制量为U,U=[Fx Fy Mz],其第k步值U(k)=[Fx(k) T
Fy(k) Mz(k)],读取步骤2.2.1)获得的整车动力学控制量可达域v和步骤4.2.2)获得的T
整车动力学备选控制量UC(k)=[FxC(k) FyC(k) MzC(k)] ;
5.2)若UC(k)∈v,则第k步整车动力学控制量U(k)=UC(k),即U(k)=[FxC(k) FyC(k) T
MzC(k)] ;
若 则对第k步整车动力学备选控制量UC(k)进行处理,得到整车动力学控制
量U(k),具体包括:
5.2.1)定义优化目标函数
B(1,:)、B(2,:)、B(3,:)分别表示效率矩阵B的第一行、第二行、第三行行向量,建立非线性优化模型
mind(k)=||UC(k)-BuC(k)||2 (24)
所述表达式(24)~(27)的含义是已知整车动力学备选控制量UC(k)和效率矩阵B,在表达式(25)~(27)的约束下,求使d(k)最小的uC(k);uC(k)为2m维的车轮力备选控制T
向量,uC(k)=[FCx1 FCy1 FCx2 FCy2 … FCxm FCym],FCxj、FCyj为第j个车轮纵向力备选控制量、侧向力备选控制量,j=1,2,…,m,m为大于等于3的正整数; 为第j个车轮
的允许制动力或驱动力的下界、上界; 为第j个车轮的允许侧向力的下界、上
界;Fmaxj为第j个车轮的允许轮胎力总力;效率矩阵B根据步骤1)获取的系统状态信息数据{X}、车轮转角、车辆底盘几何参数确定;
5.2.2)使用MATLAB V7.6.0版本软件提供的fmincon()函数对步骤5.2.1)中表达式(24)~(27)描述的非线性优化问题进行求解,结果记为 将 代入式(28)进行计算,结果即为调整后的整车动力学控制量U(k),

说明书全文

无人驾驶独立驱动和转向车辆整车动学控制量获得方法

技术领域

[0001] 本发明属于车辆动力学技术领域;特别涉及一种无人驾驶全轮独立驱动-独立转向(All Wheel Independent Drive & Steering,简称AWID-AWIS)车辆整车动力学控制量的获得方法。

背景技术

[0002] 全轮独立驱动-独立转向(AWID-AWIS)车辆是近年来国际汽车界发展的一种新型车辆,它取消了传统车辆中连接左右车轮的车轴,突破了传统驱动-转向机构的束缚,代之以新颖的车轮独立驱动-制动-转向机构,使车辆获得了驱动冗余(车辆在平面上运动仅有纵向、侧向和横摆三个自由度,但每个车轮可产生纵向和侧向两个控制力;假设车辆共有m个独立车轮,产生2m个控制力,这样驱动冗余度r=2m-3,m≥3),这在根本上保证了AWID-AWIS车辆具有传统车辆不具备的一些运动模式和难以比拟的优点,如:(1)可灵活实现小转弯半径转向、侧行和蟹行转向(所有车轮均参与转向且转向相等),显著提高车辆机动性;(2)每个车轮均可根据路面条件的变化而独立确定最佳纵向滑移率和最佳侧偏角工作点,从而提供最佳的纵向和侧向控制力;(3)可灵活地实现各车轮间转向与驱动和制动之间的协调,显著改善车辆动力、操纵和安全性能;(4)优异的机动和动力性能可实现最佳的能源利用效率,使车辆更节能、环保。AWID-AWIS车辆既可有人驾驶,也可无人驾驶。
[0003] 整车动力学控制是AWID-AWIS车辆动力学控制系统的主要组成部分之一,用以产生符合AWID-AWIS车辆动力学控制要求的控制量,即总纵向力、侧向力和横摆力矩控制量。中国专利申请《独立驱动-独立转向车辆整车动力学控制量的获得方法》(申请号:201010559872.3)描述了一种用于有人驾驶独立驱动-独立转向车辆整车动力学控制量的获得方法,用于对驾驶员方向盘转角、加速踏板开度角、制动踏板开度角指令的动力学跟踪控制;而在无人驾驶AWID-AWIS车辆上,整车动力学总控制量被用于对道路的跟踪,该专利提供的方法无法满足此要求。
[0004] 由无人驾驶AWID-AWIS车辆、道路和相关的传感、控制子系统组成的系统称为车辆-道路跟踪系统。对于该系统,目前一般采用两个步骤获得整车动力学控制量,即:
[0005] 1)利用轮速或GPS(全球定位系统)传感器获取车辆质心处的实际车速vx,利用“GIS(地理信息系统)+DGPS(差分全球定位系统)”,或车载式车道线视觉检测系统,或道路磁钉检测系统,获取车道当前跟踪点PC(过车辆质心并沿垂直于车辆纵轴方向的平面与车道中心线的交点)处的横向距离偏差Δy(车辆质心与PC点线段在道路平面上的投影线长度),以及车辆纵轴在道路平面上的垂直投影线同车道当前跟踪点PC处车道中心线切线之间的横摆角偏差Δψ;
[0006] 2)以{vxd,Δyd,Δψd}(其中Δyd=0,Δψd=0)为整车动力学控制目标期望值(vxd、Δyd、Δψd分别称为期望车速、期望距离偏差、期望横摆角偏差),计算其与步骤1)获取的vx、Δy、Δψ之间的系统跟踪期望偏差evxd=vxd-vx、eΔy=Δyd-Δy、eΔψ=Δψd-Δψ,作为整车动力学控制器的输入,利用车辆整车动力学模型和PID、滑模控制、模T
糊控制、H∞鲁棒控制、最优控制等方法计算获得整车动力学控制量U=[ Fx Fy Mz],即总纵向力控制量Fx、总侧向力控制量Fy、总横摆力矩控制量Mz,但U的计算未考虑整车动力学控制量可达域的约束作用。
[0007] 上述步骤2)获得的整车动力学控制量UC最终被分解到底层各车轮,以车轮纵向控制力和侧向控制力的形式加以执行,实现对AWID-AWIS车辆整车动力学的控制。
[0008] 这种方法存在如下不足:
[0009] (1)未考虑底层各车轮的纵向力和侧向力信息,以及据此计算获得的整车动力学控制量可达域信息,这使得最后获取的整车动力学控制量 可能不尽合理,无法由存在约束的底层车轮纵向和侧向控制力有效执行,从而产生整车动力学控制量与系统控制能力间的冲突。因此有必要计算整车动力学控制量可达域信息。
[0010] (2)直接以系统跟踪误差evxd、eΔy、eΔψ为整车动力学控制器的输入,这样当跟踪误差较大、误差变化率过快时,计算获得的整车动力学控制量 也比较C
大。此时,如果整车动力学控制量可达域较小,即系统控制能力有限,U 就得不到完全执行,同样会出现整车动力学控制量与系统控制能力间的冲突问题。因此有必要对系统跟踪误差C
进行处理,在允许的情况下通过对evxd、eΔy、eΔψ的调整使整车动力学控制器计算得到的U尽可能地小,进而加大系统稳定裕量。
[0011] (3)没有考虑对系统扰动的实时观测和利用,这会导致为考虑系统控制鲁棒性而生成的整车动力学控制量过于保守,也有可能超越底层车轮控制力的约束而无法得到有效执行,并由此产生附加扰动。特别是,当系统扰动和附加扰动超越底层各车轮的实际控制能力时,系统控制就会失稳。
[0012] 上述不足使得无人驾驶AWID-AWIS车辆在低附着系数路面、分离路面上行驶,特别是高速行驶时的动力学控制效果不理想,有时甚至会使车辆发生失稳、失控等严重问题。

发明内容

[0013] 本发明的目的是为克服上述现有技术的不足,提供一种无人驾驶独立驱动-独立转向车辆的整车动力学控制量的获得方法,该方法在获取车辆-道路跟踪系统信息的基础上,计算整车动力学控制量可达域,据系统系统跟踪期望偏差进行调整,对最终获得的整车动力学控制量的可行性加以判断、处理,同时还实时估计并利用了系统扰动信息,从而提高计算获得的整车动力学控制量的有效性、合理性和鲁棒性能,使无人驾驶AWID-AWIS车辆能够在低附着系数路面、分离路面上以更好的精度、更高的速度跟踪曲率更大的道路路径,车辆动力学控制效果理想,行驶安全。
[0014] 为实现上述目的,本发明采用下述技术方案:
[0015] 一种无人驾驶独立驱动和转向车辆整车动力学控制量获得方法,包括以下步骤:
[0016] 1)估计车辆质量转动惯量,采集车辆-道路跟踪系统中与车辆质心对应的实际车速、横向距离偏差和横摆角偏差数据,以及用于车辆-道路跟踪的车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶AWID-AWIS车辆整车动力学控制所需的系统状态信息数据{X};
[0017] 2)根据步骤1)获取的系统状态信息数据,利用有约束几何映射法计算整车动力学控制量可达域;
[0018] 3)根据步骤1)获取的系统状态信息数据及步骤2)获取的整车动力学控制量可达域信息数据,计算系统跟踪期望偏差;
[0019] 4)利用无人驾驶AWID-AWIS车辆-道路跟踪系统动力学模型和步骤3)生成的系统跟踪期望偏差,结合步骤1)获取的系统状态信息数据,采用带扰动实时估计的鲁棒控制方法生成整车动力学备选控制量,该整车动力学备选控制量由总纵向力备选控制量、总侧向力备选控制量、总横摆力矩备选控制量构成;
[0020] 5)结合步骤2)获得的整车动力学控制量可达域,对步骤4)生成的整车动力学备选控制量的可行性进行判断和调整,获得整车动力学控制量,即总纵向力控制量、总侧向力控制量、总横摆力矩控制量。
[0021] 本发明的技术特点及效果:
[0022] 本发明增加了整车动力学控制量可达域计算功能,计算中增加了控制约束条件,提出了整车动力学控制量可达域计算的二等分角逼近法和有约束几何映射法,为整车动力学控制量的获得提供了约束信息;
[0023] 增加了对无人驾驶AWID-AWIS车辆-道路跟踪系统跟踪误差进行调整的功能,提供了实现方法,能够弱化或消除整车动力学控制量和系统实际控制能力间的冲突,加大了车辆-道路跟踪系统的稳定裕量;
[0024] 增加了对整车动力学备选控制量的可行性进行判断和调整并获得整车动力学控制量的功能,提出了两步法计算整车动力学控制量:首先计算整车动力学备选控制量,然后结合整车动力学控制量可达域约束信息对其可行性进行判断和处理,提高了整车动力学控制量计算的精确性,能够减弱或消除计算获得的控制量与系统实际控制能力间的冲突,增强系统控制的鲁棒性;
[0025] 增加了对系统扰动进行实时估计与补偿的功能,提供了实现方法,提高了车辆整车动力学控制量的合理性,改善了控制的快速性和准确性;
[0026] 改善了整车动力学控制量的有效性、合理性和整车动力学控制的鲁棒性,提高了无人驾驶AWID-AWIS车辆在低附着系数路面、分离路面和高速时的道路跟踪性能,动力学控制效果理想,行驶安全。附图说明
[0027] 图1是本发明无人驾驶AWID-AWIS车辆整车动力学控制量获得方法的流程框图
[0028] 图2是本发明的用二等分角逼近法求每个车轮控制量非线性约束域的矩形逼近序列集合的示意图。

具体实施方式

[0029] 下面结合附图和实施例对本发明进一步说明。
[0030] 本发明的无人驾驶AWID-AWIS车辆整车动力学控制获得方法如图1所示,包括以下步骤:
[0031] 1)估计车辆质量和转动惯量,采集车辆-道路跟踪系统中与车辆质心对应的实际车速、横向距离偏差和横摆角偏差数据,以及用于车辆-道路跟踪的车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶AWID-AWIS车辆整车动力学控制所需的系统状态信息数据{X};具体方法如下:
[0032] 1.1)所述步骤1)中估计车辆质量和转动惯量,具体为利用无人驾驶AWID-AWIS车辆标称质量mn和标称转动惯量Izn,获取车辆质量估计值mest=mn、转动惯量估计值Izest=Izn;
[0033] 1.2)所述步骤1)中采集车辆-道路跟踪系统中与车辆质心对应的实际车速、横向距离偏差和横摆角偏差数据,具体为利用“GIS(地理信息系统)+DGPS(差分全球定位系统)”,或车载式车道线视觉检测系统,或道路磁钉检测系统,采集车道当前跟踪点PC(过车辆质心并沿垂直于车辆纵轴方向的平面与车道中心线的交点)处的横向距离偏差Δy(车辆质心与PC点线段在道路平面上的投影线长度),以及车辆纵轴在道路平面上的垂直投影线同车道当前跟踪点PC处车道中心线切线之间的横摆角偏差Δψ,采集方法属于公知技术;
[0034] 1.3)所述步骤1)中采集用于车辆-道路跟踪的车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶AWID-AWIS车辆整车动力学控制所需的系统状态信息数据,具体为利用GIS+DGPS,或车载式车道线视觉检测系统,或道路磁钉检测系统,获取车道当前跟踪点PC处的道路中心线曲率ρPc,利用轮速传感器、GPS(全球定位系统)、VG(垂直陀螺仪)采集车辆运动学、动力学基本信息,结合信息融合方法获取无人驾驶AWID-AWIS车辆整车动力学控制所需的车速vx和系统附加状态信息数据{X}0(包括车辆纵向加速度、侧向加速度、俯仰角、侧倾角、质心侧偏角和横摆角速率数据,以及车道当前跟踪点PC处的道路中心线曲率ρPc),采集、获取vx和{X}0的方法属于公知技术。系统基本状态信息数据{mest,Izest,vx,Δy,Δψ}与{X}0的并集构成系统状态信息数据{X}。
[0035] 2)根据步骤1)获取的系统状态信息数据,利用有约束几何映射法计算整车动力学控制量可达域,具体包括:
[0036] 2.1)整车动力学控制量可达域计算模型表达式为:
[0037]
[0038]
[0039]
[0040]
[0041] 所述表达式(1)~(4)的含义是已知u和B,求v;式中v为整车动力学控制量可达域,是一个由总纵向力控制量Fx、总侧向力控制量Fy、总横摆力矩控制量Mz构成的3维有界函数空间区域;效率矩阵B根据步骤1)获取的系统状态信息数据{X}、车轮转角、车辆底盘几何参数确定(确定方法属于公知方法,参见文献:李道飞,喻凡.基于最优轮胎力分配的车辆动力学集成控制[J].上海交通大学学报,2008,42(6):887-891.);u为2m维的车轮控制量,由m个车轮纵向力和m个侧向力构成; 为第j个车轮的允许制动力或驱动力的下界、上界,j=1,2,…,m;m为大于等于3的正整数; 为第j个
车轮的允许侧向力的下界、上界;Fmaxj为第j个车轮的允许轮胎力总力;Fxj、Fyj为第j个车轮纵向力控制量、侧向力控制量 的取值与制动器、驱动器
转向系统的能力和允许轮胎力总力Fmaxj信息有关, 和Fmaxj均
可使用公知方法获得(参见文献Eiichi Ono,et al.Estimation of tire grip margin using electric power steering system[J].Vehicle System Dynamics,2004,vol.41,sup:421-430.(小野英一等.《使用电子助力转向系统估计轮胎附着力极限》[J].《车辆系统动力学》杂志,2004,vol.41,sup:421-430.)和文献:Yasui Yoshiyuki,et al.Estimation of lateral grip margin based on self-al igning torque for vehicle dynamics enhancement[J].SAE Paper,No.2004-01-1070.(安井 善行等.《车辆动力学控制中基于自回正力矩的轮胎侧向附着力极限估计》[J],SAE论文,No.2004-01-1070.))
[0042] 2.2) 求 每 个 车 轮 的 线 性 约 束 条 件 式 (3) ~ (4) 的 交 集为 第 j 个 车 轮 控 制量 线性 约 束 域,以及 每 个 车 轮 的非 线 性 约 束 条件 式(2) ~(4)的 交 集为第j个车轮控制量
非线性约束域,j=1,2,…,m,m为大于等于3的正整数;
[0043] 2.2.1)计算整车动力学控制量可达域v:如果 则直接以 为约束条件计算v(计算方法属于公知方法,见文献:Durham,W.C.,Constrained Control Allocation:Three Moment Problem.Journal of Guidance,Control,and Dynamics,1994,17(2):330-336.(杜哈姆W.C.《有约束控制分配中的三力矩问题》,《制导、控制与动力学》杂志,1994,17(2):330-336));如果
则首先使用二等分角逼近法求每个车轮控制量非线性约束域 的矩形逼近序列集合其中
为第j个车轮控制量非线性约束域 的第s个逼近矩形的纵向力的上、下界,
为其侧向力的上、下界,s=1,2,…,p0,p0根据计算精度要求确定,j=
1,2,…,m,m为大于等于3的正整数,则整车动力学控制量可达域计算模型表达为式(1)和式(5)~(6),然后再使用公知方法(见文献:Durham,W.C.,Constrained Control Allocation:Three Moment Problem.Journal of Guidance,Control,and Dynamics,1994,
17(2):330-336.(杜哈姆W.C.《有约束控制分配中的三力矩问题》,《制导、控制与动力学》s
杂志,1994,17(2):330-336))计算每个 对应的控制量可达域子域v,s=1,2,…,p0,s s
取所有v 的并集作为整车动力学控制量可达域v,v=∪(v);
[0044]
[0045]
[0046] 本发明用二等分角逼近法求每个车轮控制量非线性约束域的矩形逼近序列集合方法如图2所示;图2中, 剖面线标记的扇形区域为第j个车轮控制量非线性约束域 s=1,2,…p0,j=1,
2,…,m,其中 表示第一次逼近 得到的矩形域, 表示第二次逼近 得到的矩
形域, 表示第三次逼近 得到的矩形域,…,依次细分,直至逼近精度满足要求为止(上述方法中,每次逼近都对剩余扇形区域作45°等角划分,然后取逼近矩形,称为车轮控制量非线性约束域计算的二等分角逼近法);
[0047] 步骤2.1)、2.2)、2.2.1)描述的方法称为有约束几何映射法。
[0048] 2.2.1.1)步骤2.2.1)中p0根据计算精度要求确定,具体为记第s个逼近矩形的面积为Ss,记允许逼近误差ε=0.05,按如下步骤计算p0:
[0049] 第一步:p0赋初值1,即p0=1,计算非线性约束域 的面积,记为S;
[0050] 第二步:计算第p0个逼近矩形的面积Sp0;
[0051] 第三步:计算从第1个到第p0个逼近矩形的面积之和 判断 是否成立,若成立,p0值计算结束;若不成立,执行第四步;
[0052] 第四步:p0加1,转第二步。
[0053] 3)根据步骤1)获取的系统状态信息数据及步骤2)获取的整车动力学控制量可达域信息数据,计算系统跟踪期望偏差;具体方法如下:
[0054] 3.1)设定整车动力学控制目标期望值的初始值:期望车速 期望距离偏差Δyd=0,期望横摆角偏差Δψd=0,计算其与步骤1)获取的vx、Δy、Δψ之间的系统跟踪期望偏差初始值: 依据车道当前跟踪点PC处的道路中心线曲率ρPc、车辆最大侧向加速度约束aymax确定,如式(7):
[0055]
[0056] 3.2)根据步骤2)获取的整车动力学控制量可达域v,利用一组专家规则(规则1、规则2、…、规则n,n为大于等于3的正整数)对步骤3.1)获取的 和 进行调整,举例如下:
[0057] 规则1:如果v较大,而 和 的绝对值都较小,则无需对 和 进行调整,系统跟踪期望偏差
[0058] 规则2:如果v较小,而 和 的绝对值都为中等大小,则使用式(8)~(10)对 和 调整,得到系统跟踪期望偏差evxd、eΔy和eΔψ:
[0059]
[0060]
[0061]
[0062] Ts为车辆-道路跟踪系统控制周期;2Tvxd、2TΔy、2TΔψ为时间常数,根据专家经验确定,取作Ts的2.5倍,
[0063]
[0064] 规则n:如果v较小,而 和 的绝对值都较大,则使用式(11)~(13)对和 进行调整,得到系统跟踪期望偏差evxd、eΔy和eΔψ:
[0065]
[0066]
[0067]
[0068] nTvxd、nTΔy、nTΔψ为时间常数,根据专家经验确定,取作Ts的5.0倍。
[0069] 3.2.1)步骤3.2)中的“较小”、“中等大小”、“较大”为模糊隶属度取值,利用基于专家经验的模糊逻辑方法确定,正整数n根据v、 和 四个变量模糊子域的划分和具体采用的模糊推理方法确定,上述模糊隶属度取值以及基于专家经验的模糊逻辑方法均为模糊逻辑控制技术领域的公知技术;规则3~规则n-1的设计与上述方法类似。
[0070] 4)利用无人驾驶AWID-AWIS车辆-道路跟踪系统动力学模型和步骤3)生成的系统跟踪期望偏差,结合步骤1)获取的系统状态信息数据,采用带扰动实时估计的鲁棒控制方法生成整车动力学备选控制量,该整车动力学备选控制量由总纵向力备选控制量、总侧向力备选控制量、总横摆力矩备选控制量构成;具体包括:
[0071] 4.1)全轮独立驱动-独立转向车辆整车动力学模型表达式为:
[0072]
[0073]
[0074]
[0075] 式中 分别为vx、Δy、Δψ的一阶和二阶导数;mest为车辆质量估计值,Izest为转动惯量估计值;Fx为总纵向力控制量、Fy为总侧向力控制量、Mz为总横摆力矩控制量;fvx、fΔy和fΔψ分别为无人驾驶AWID-AWIS车辆-跟踪系统纵向、横向和横摆运动
3个动力学通道“内扰+外扰”的“总和”(“内扰”、“外扰”、“内扰+外扰”、“总和”是自抗扰控制(ADRC)这一公知鲁棒控制技术中的公知概念,见文献:韩京清.自抗扰控制技术-估计补偿不确定因素的控制技术[M].北京:国防工业出版社,2009.);
[0076] 4.2)使用带“内扰”和“外扰”估计功能的ADRC鲁棒控制器计算整车动力学备选控制量:
[0077] 4.2.1)采用式(17)所示的二阶离散扩张状态观测器对fvx进行实时估计,采用式(18)所示的三阶离散扩张状态观测器对fΔy和fΔψ分别进行实时估计;
[0078]
[0079]
[0080] 式(17)和式(18)中,k代表当前控制步,h为控制周期;y(k)代表vx、Δy或Δψ的第k步测量值;z1(k)代表vx、Δy或Δψ的第k步估计值;e为vx、Δy或Δψ第k步测量值y(k)和估计值z1(k)之间的偏差;β01、β02、β03、α1、α2、β、δ0为控制器参数;fal(e,α1,δ0)、fal(e,α2,δ0)分别由表达式(19-1)、(19-2)表达,sign(e)表示e的符号函数;式(17)中,z2(k)代表fvx的估计值,b0=1/mest,u(k)=FxC(k),即第k步总纵向力备选控制量FxC(k);式(18)中,z2(k)代表Δy或Δψ一阶导数的估计值,z3(k)代表fΔy或fΔψ的估计值,b0=-1/mest(对应fΔy估计),或b0=-1/Izest(对应fΔψ估计),u(k)=FyC(k)或u(k)=MzC(k),即第k步总侧向力备选控制量FyC(k)或总横摆力矩备选控制量MzC(k);控制器参数β01、β02、β03、α1、α2、β、δ0的设计为公知方法(见文献:韩京清.自抗扰控制技术-估计补偿不确定因素的控制技术[M].北京:国防工业出版社,2009.);
[0081]
[0082]
[0083] 4.2.2)计算整车动力学备选控制量:采用式(20)所示的一阶离散非线性比例控制器对fvx进行实时补偿,采用式(21)所示的二阶离散非线性比例控制器对fΔy和fΔψ分别进行实时补偿,对各通道误差进行反馈校正;
[0084]
[0085]
[0086] 式(20)和式(21)中,fal(e1,αp,δp)、fal(e2,αd,δd)由式(22-1)、式(22-2)分别表达;KP、Kd、αP、δP、αd、δd为控制器参数,u0为中间变量;式(20)中,e1是evxd的跟踪信号,b0、u(k)、z2(k)意义同式(17);式(21)中,e1是eΔy或eΔψ的跟踪信号,e2是eΔy或eΔψ的跟踪微分信号,b0、u(k)、z2(k)意义同式(18);无人驾驶AWID-AWIST车辆整车动力学备选控制量是一个3维矢量,记为UC,UC=[FxC FyC MzC],第k步值T为转置符号;控制器参数KP、Kd、αP、δP、αd、δd的设
计为公知方法(见文献:韩京清.自抗扰控制技术-估计补偿不确定因素的控制技术[M].北京:国防工业出版社,2009.);e1、e2使用离散形式的跟踪微分器(TD)算法计算,亦为公知方法(见文献:韩京清.自抗扰控制技术-估计补偿不确定因素的控制技术[M].北京:国防工业出版社,2009,pp66~73.)
[0087]
[0088]
[0089] 步骤4.1)、4.2)、4.2.1)、4.2.2)描述的方法称为无人驾驶AWID-AWIS车辆-道路跟踪系统整车动力学备选控制量计算的带扰动实时估计的鲁棒控制方法。
[0090] 5)结合步骤2)获得的整车动力学控制量可达域,对步骤4)生成的整车动力学备选控制量的可行性进行判断和调整,获得整车动力学控制量,即总纵向力控制量、总侧向力控制量、总横摆力矩控制量,具体包括:
[0091] 5.1)记Fx(k)、Fy(k)、Mz(k)分别为总纵向力控制量Fx、总侧向力控制量Fy、总横T摆力矩控制量Mz的第k步值,整车动力学控制量为U,U=[Fx Fy Mz],其第k步值U(k)=T
[Fx(k) Fy(k) Mz(k)],读取步骤2.2.1)获得的整车动力学控制量可达域v和步骤4.2.2)T
获得的整车动力学备选控制量UC(k)=[FxC(k) FyC(k) MzC(k)] ;
[0092] 5.2)若UC(k)∈v,则第k步整车动力学控制量 即U(k)=[FxC(k)T
FyC(k) MzC(k)] ;
[0093] 若 则对第k步整车动力学备选控制量UC(k)进行处理,得到整车动力学控制量U(k),具体包括:
[0094] 5.2.1)定义优化目标函数
[0095]
[0096]
[0097] B(1,:)、B(2,:)、B(3,:)分别表示效率矩阵B的第一行、第二行、第三行行向量,建立非线性优化模型
[0098] min d(k)=||UC(k)-BuC(k)||2 (24)
[0099]
[0100]
[0101]
[0102] 所述表达式(24)~(27)的含义是已知整车动力学备选控制量UC(k)和效率矩阵B,在表达式(25)~(27)的约束下,求使d(k)最小的uC(k);uC(k)为2m维的车轮力备选控制向量,uC(k)=[FCx1 FCy1 FCx2 FCy2…FCxm FCym]T,FCxj、FCyj为第j个车轮纵向力备选控制量、侧向力备选控制量,j=1,2,…,m,m为大于等于3的正整数; 为第j个车轮的允许制动力或驱动力的下界、上界; 为第j个车轮的允许侧向力的下界、上
界;Fmaxj为第j个车轮的允许轮胎力总力;效率矩阵B根据步骤1)获取的系统状态信息数据{X}、车轮转角、车辆底盘几何参数确定;
[0103] 5.2.2)使用MATLAB V7.6.0版本软件提供的fmincon()函数对步骤5.2.1)中表达式(24)~(27)描述的非线性优化问题进行求解,结果记为 此方法为公知技术;将代入式(28)进行计算,结果即为调整后的整车动力学控制量U(k),
[0104]
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈