一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法及系统

摘要: 本发明涉及智能网联商用车编队控制,特别是一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法及系统。背景技术:1、随着干线物流自动化发展,半挂卡车编队行驶凭借空气...
一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法及系统

本发明涉及智能网联商用车编队控制,特别是一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法及系统。

背景技术:

1、随着干线物流自动化发展,半挂卡车编队行驶凭借空气阻力节油、通行效率提升的优势成为行业研究热点。当前半挂卡车编队控制方案多基于时间域动力学模型构建,在山区公路连续弯坡、起伏坡道等复杂线形场景下,道路曲率、坡度与车辆动力学的耦合误差被放大,轨迹跟踪精度与编队稳定性显著下降。半挂车铰接结构引入的牵引车与挂车间相对转动自由度,使得弯道工况下的运动学耦合关系更为复杂,时间域模型难以准确描述随道路弧长变化的曲率与坡度对铰接动态的持续影响。

2、在铰接稳定控制方面,现有方案多以铰接角硬约束或事后制动干预为主,仅针对铰接单一维度设计反馈修正,缺少编队协同、车辆跟踪、铰接稳定三层联动的系统化前馈预判机制,极端弯道工况下易出现干预滞后、优化无解的问题。现有乘用车双层曲率自适应mpc仅适用于单车路径跟踪,且仅通过单输入(航向偏差)调整预测时域,无法同步调节稳定权重与约束裕度,不能适配半挂折头、挂车摆振等多重失稳工况;多数方案仅单点实时曲率更新约束,未构建整条前瞻序列动态约束边界,弯道全程约束匹配差,易优化无解。

3、在分布式编队架构上,传统单车mpc仅区分预测、最优两类轨迹,缺少用于v2v交互的假设轨迹定义与滚动更新规则,编队协同计算缺少标准化交互载体;传统分层控制仅上层单向下发指令,下层稳定状态无法反向修正上层优化边界,分布式架构下v2v通信延迟与丢包对编队稳定性的影响亦缺乏系统性处理;现有风阻模型固定系数,未随编队弧长间距动态修正,高速弯模型失配明显。

4、综上,现有技术线形适配差、失稳干预滞后、自适应维度单一、编队交互逻辑不完善,无法满足山区干线编队高精度稳定行驶需求。因此,需要提出一种复杂道路线形下半挂卡车编队控制优化方法,解决现有方案线形适配性差、折头抑制滞后、分层协同不足、风阻耦合考虑缺失的问题。

技术实现思路

1、有鉴于此,本发明的目的在于提供一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法及系统,通过空间域弧长建模适配弯坡复合道路,设计多维度道路曲率前置补偿机制抵消曲率扰动;采用曲率幅值、曲率变化率双输入模糊多维度自适应调控,同步调整预测参数、稳定权重、约束裕度;构建预测、假设、最优三类轨迹的完整流转体系,规范分布式编队交互逻辑;结合上下层双向协同架构与牵引挂车分轴差动制动兜底,兼顾行驶安全、路径跟踪精度、编队队形一致性多优化目标。

2、为实现上述目的,本发明采用如下技术方案:一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法,其特征在于,具体实现步骤如下:

3、步骤s1、实时获取前方道路的离散坐标点及坡度、超高,采集自身状态信息、编队内其他卡车状态信息,建立车辆耦合动力学方程;

4、步骤s2,通过链式法则转换至空间域,将曲率、坡度线形参数映射为滚动空间预测域优化中的动态约束,实现失稳风险前馈抑制;

5、步骤s3、对空间域非线性模型及约束线性化,构建多目标优化函数并转化为二次型求解,获得最优轨迹和控制序列;

6、步骤s4、采用分层协同控制,上层分布式mpc完成路径、速度和编队间距协同控制;下层基于铰接相平面判定失稳趋势,预警区向上层反馈收紧安全边界,危险区触发制动干预。

7、在一较佳的实施例中,步骤s1的具体实现过程如下:

8、步骤s11、通过车载高精地图获取道路参考路径的离散坐标点序列(x,y),以及纵坡坡度、横向超高;

9、通过车载传感器与铰接角采集单元获取自身车辆状态信息,包括牵引车纵向速度v1x、横向速度v1y、横摆角速度、铰接角γ、铰接角速度;挂车横摆角速度由合成得到;牵引车质量m1,挂车质量m2,牵引车横摆转动惯量iz1,挂车横摆转动惯量iz2,牵引车轴距lf,挂车轴距lr,质心至牵引销距离lc1、lc2,轮距b,质心高度hg整车物理参数,由车辆控制器中预置的整车参数表提供;轮胎侧偏刚度系数f由轮胎试验数据拟合得到;

10、通过v2v通信获取编队内邻居车辆状态信息,包括前车与领头车的位置sj、前车与领头车的速度uj、前车与领头车的横摆角、前车与领头车的铰接角γj,用于后续协同误差项ei,coop的计算与假设轨迹的交互;

11、通过车载路面状态估计算法实时获取当前路面附着系数μ,作为轮胎力边界与半挂列车稳定性约束tssc稳定边界的计算依据;采用保守安全值μsafe:

12、

13、式中,μmin为路面最低附着下限;为实时估计附着系数;kμ为安全裕度系数;σμ为附着估计方差;

14、对离散参考路径点进行五次多项式平滑,得到连续二阶可导路径函数y=f(s),以弧长s为自变量,计算曲率与曲率变化率:

15、

16、按预测时域范围截取对应弧长区间的曲率值,形成前瞻曲率序列,作为模型预测控制的已知外部输入参数;

17、步骤s12、采用牛顿-欧拉多体框架构建牵引车、挂车各含纵向、横向、横摆运动的六自由度完整刚体动力学方程组;基于牵引销铰接速度约束构造零空间投影矩阵,消去挂车纵向、横向非独立运动分量,降维得到仅含牵引车纵向、横向、横摆、挂车横摆4个独立物理自由度的4阶刚体运动模型;在此基础上,将铰接角作为独立状态量引入状态向量,组合形成包含牵引车纵向速度、横向速度、横摆角速度、挂车横摆角速度及铰接角共5个状态变量的五状态耦合预测模型,其中,为牵引车横摆角,为挂车横摆角;五状态耦合预测模型中引入道路坡度、超高对应的重力分量,适配复杂弯坡道路受力特性;

18、采用坡度分解方法将综合坡度角解耦为纵向爬坡角与横向侧倾角,完成重力分量的纵横向解耦计算;基于前瞻曲率序列预计算弯道稳态侧偏角、稳态横摆角速度、稳态铰接角作为线性化基准工作点;

19、轮胎侧偏刚度随轴垂载线性变化ci:

20、ci=f·fzi

21、式中,f为归一化侧偏刚度,fzi为对应车轴的垂直载荷;各轴垂直载荷根据车辆总质量、轴荷分布与弯道侧向载荷转移计算;

22、步骤s13,基于图论完成编队通信拓扑的标准化建模,定义邻接矩阵、入度矩阵并引入牵引矩阵,给出前车-领航者跟随拓扑plf、双前车跟随拓扑tpf;两种通信拓扑的矩阵化表达,为拓扑动态切换与稳定性分析提供统一数学框架;

23、步骤s14,建立考虑编队车间距修正的半挂卡车空气阻力模型,分别计算牵引车与挂车的风阻受力,将风阻嵌入纵向动力学方程,风阻系数随本车与前车的弧长间距动态修正;

24、构建跟驰间距相关动态风阻模型,整车空气阻力合力fw:

25、

26、动态减阻风阻系数指数衰减:

27、

28、式中:ρ为空气密度;a为迎风面积;cd为单车风阻系数;ds为车间弧长间距;ηd为最大减阻率;为衰减特征长度;dmin为最小安全车距;cd0为单车标准风阻系数;vx为车辆纵向速度。

29、在一较佳的实施例中,步骤s2的具体实现过程如下:

30、步骤s21、基于链式法则执行时间域到空间域的转换,采用完整frenet关系:

31、

32、式中,s为道路中心线弧长,为弧长速度,vx为车辆纵向速度,vy为车辆质心处的横向速度,为车辆航向与道路切线的夹角,ey为横向位置偏差,表示道路曲率,f(x,u)为车辆非线性状态空间方程的时间域形式,x为状态向量,u为控制向量;设置规避低速工况下的空间域奇异问题;转换后所有车辆状态、跟踪误差、约束条件均映射至弧长坐标系下,编队期望车距定义为沿道路的弧长间距;

33、转换后,本车动力学状态、跟踪误差及约束条件均以弧长s为自变量;编队内期望车距定义为沿道路的弧长间距,邻居车辆状态经v2v通信获取后直接以弧长坐标对齐,无需额外转换;为保证在低速工况下有正下界,

34、令,其中;表示道路曲率,表示弧长速度的最小允许值;

35、采用空间采样步长δs对上述空间域微分方程进行前向欧拉离散化,得到非线性离散状态空间模型:

36、  其中,x(s) 为当前弧长步的状态向量,u(s) 为当前弧长步的控制输入,为状态量对时间的变化率, 为由完整frenet关系确定的弧长速度;

37、该离散状态空间模型作为步骤s3线性化与滚动优化的基础被控对象;

38、步骤s22、硬约束按优先级从高到低排序为:tssc含横摆稳定包络与侧翻ltr限制,其后依次为轮胎附着椭圆约束、驱动/制动扭矩约束、横向位置边界约束;其中,tssc以铰接角、牵引车-挂车横摆角速度差为核心变量,是防止折头、挂车摆振的核心安全边界,全程不可松弛;

39、采用前瞻序列式动态约束体系,预测时域内每一弧长步的约束边界按以下规则更新:曲率与坡度联动更新横向加速度上限与扭矩限幅,路面附着系数联动更新轮胎力边界与tssc包络范围,车道宽度联动更新横向位置边界;

40、tssc采用归一化椭球约束形式:

41、

42、式中,zs为稳定状态向量,γ为铰接角,为铰接角速度,为牵引车与挂车横摆角速度差,ltr为横向载荷转移率;ps为随速度v、路面附着系数μ、车辆质量m动态变化的椭球矩阵,t表示转置;

43、弯道安全车速由横向加速度限值与铰接稳定边界联合确定,取两者下界:

44、

45、式中,ay,max为由路面附着与侧翻阈值联合确定的横向加速度上限;为由横向加速度上限推导的车速限值,时有效,为由铰接角稳定边界推导的车速上限,与曲率幅值负相关;

46、步骤s23、基于整条前瞻曲率序列设计多维度稳态前馈补偿项,分别从编队协同车速、牵引车转向、半挂铰接稳态三个维度提前补偿道路曲率带来的运动偏差,所有前馈量共同构成稳态前馈基准,输入至s3作为滚动优化的初始参考与热启动初值:

47、①结合前瞻曲率规划全车队同步平滑速度曲线,对加速度、加加速度设置上下限约束,保证弯道下编队行驶速度同步,减小车间铰接冲击;

48、②引入车速不足转向修正项构建稳态转向前馈量,计算公式如下:

49、式中δff(s)为稳态转向前馈量;l为牵引车轴距;kv为不足转向梯度,表征车速对转向增益的修正;v1x(s)为牵引车纵向速度;kγ为铰接角补偿系数,用于将铰接角映射为前轮转角补偿量;γref(s)为稳态期望铰接角;

50、③摒弃纯几何铰接角计算方式,引入车速动力学补偿系数,推导适配高速工况的稳态期望铰接角:

51、式中,为牵引车质心至牵引销纵向距离,为挂车质心至牵引销纵向距离;

52、低附着系数路面下kvγ自动下调以保证铰接角前馈补偿量不超出轮胎力附着极限;同时在滚动优化目标函数内增设铰接角、铰接角速度的软惩罚约束,依靠反馈控制进一步削弱铰接角动态波动,同步抑制牵引车折叠、挂车摆振两类失稳工况;

53、上述速度前馈、转向前馈与铰接角前馈三者共同构成曲率扰动的前馈补偿机制,在预测控制滚动优化之前预先修正参考轨迹与稳态基准,从而实现失稳风险的前置抑制;

54、步骤s24,构建分层约束域协调机制,以归一化铰接稳定裕度为约束指标,嵌入上层优化问题的可行域限制,约束形式为:

55、

56、式中,为预测时域内第j步的归一化稳定裕度,ms,min,i(s)为当前弧长下的稳定裕度最低要求,为上一弧长步的稳定裕度实际值;β为稳定裕度调节系数,为曲率、纵坡二元动态函数,直道增大β拓展经济优化空间,弯坡自动收窄β收紧稳定边界。

57、在一较佳的实施例中,步骤s3的具体实现过程如下:

58、步骤s31、每个控制周期以滚动移位后的上周期最优轨迹作为预测轨迹,同时叠加s42反馈的上周期差动制动状态修正量更新初始状态;对空间域非线性动力学模型及全部非线性tssc稳定约束同步执行一阶泰勒展开线性化;实时校验线性化误差,误差超限则更新稳态工作点;

59、以曲率幅值、曲率变化率双输入构建模糊控制器,同步动态调整预测步数、铰接角偏差的惩罚权重矩阵qγ;同步根据当前曲率、坡度更新稳定裕度系数β、风阻权重ww,平衡控制精度、计算效率与行驶稳定性;

60、步骤s32、构建多目标优化函数,融合硬约束边界与软约束惩罚项:

61、

62、式中,ji表示第辆车总优化代价函数,np表示预测时域步数,j表示车辆,ni表示邻居车辆总数,ei,track为个体轨迹跟踪误差,ei,coop,l为与邻居车辆l的状态协同误差,δγi为铰接角偏差,δμi为控制量增量,q为轨迹跟踪误差权重矩阵,f为编队协同误差权重矩阵,qγ为铰接角偏差惩罚权重矩阵,r为控制量增量惩罚权重矩阵,p为终端代价权重矩阵;pw,i为车辆空气阻力功率,pw,base为基准功率,为横摆摆振惩罚权重,为牵引车横摆角速度,为挂车横摆角速度,为横摆角速度差,为终端状态误差向量,为预测时域末端时刻,s为当前弧长位置,表示在s时刻预测未来第 的弧长位置;

63、为横摆摆振惩罚项,权重,弯道曲率越大稳定惩罚权重越高,优先抑制挂车横摆摆振风险;为松弛因子惩罚项;为横摆摆振惩罚基准权重;为曲率敏感系数;

64、步骤s33、将所有线性化约束整理为不等式约束,采用上一周期最优解热启动qp求解;求解无可行域时,松弛因子优先自动调节软约束,仍无可行解则按约束优先级由低到高逐级放松相对硬约束,tssc绝对安全硬约束在任何情况下均不予放松;

65、将每一控制周期内优化问题的解空间划分为三类具有不同生命周期与交互属性的轨迹序列,分别为预测轨迹、假设轨迹与最优轨迹。

66、在一较佳的实施例中,所述预测轨迹定义为上一周期最优轨迹经滚动移位后形成的开环状态序列,存储于本地控制器中,作为当前周期模型线性化的工作基点与优化求解的热启动初值;

67、所述假设轨迹定义为由当前周期最优轨迹经截断、移位并代入终端状态更新规则进行补全后所得的完整预测时域序列;该轨迹通过v2v通信链路广播至编队内邻居车辆,作为邻居车辆构建协同误差项的外部一致性基准,以保证分布式优化中各车优化命题的相容性;

68、所述最优轨迹定义为当前周期二次规划问题的可行最优解序列,其首段控制量输出至执行机构,剩余段经滚动移位后分别用于更新下一周期的预测轨迹与假设轨迹;

69、假设终端状态更新规则由滚动移位操作、弧长坐标对齐约束及终端可行集投影构成,其更新形式为

70、

71、式中k为终端反馈增益,由离散代数黎卡提方程

72、求解;控制器权重满足正定闭环稳定准则,为参数整定提供量化理论依据;为车辆在下一周期的假设终端状态,as为离散状态矩阵,为车辆 在当前周期的假设终端状态,bs为离散输入矩阵,k为终端反馈增益矩阵,为对邻居车辆求和,为邻居车辆 j在当前周期的假设终端状态,为车辆 i在当前周期的假设终端状态;为车辆的邻居集合;表示车辆j与i期望弧长间距向量。

73、在一较佳的实施例中,步骤s4的具体实现过程如下:

74、步骤s41、采用同步分布式预测控制框架,支持plf、tpl通信拓扑动态切换;引入通信延迟补偿机制;上层采用增量式增广状态模型:

75、

76、为下一弧长步的增广状态向量,为当前弧长步的增广状态向量,δs为空间采样步长,为增广状态矩阵,为增广输入矩阵,δu(s)为控制量增量向量,ξ(s)为原始状态向量,u(s-δs)为上一周期的控制输入;

77、每辆车求解得到最优轨迹后,舍弃首段状态,将剩余段,作为下一周期s+δs时刻假设轨迹的前np段,j=0,1,...,np-1,末段由终端状态更新规则补全;通过v2v广播将假设轨迹传至邻居车辆,各车假设轨迹的终端状态按步骤s3所述规则更新补全,通过终端反馈增益保证预测时域末端状态渐近收敛至期望队列,在通信拓扑连通、时延满足上限的前提下,支撑分布式优化的相容性与编队一致性;接收邻居假设轨迹代入协同误差项完成优化,协同误差的加权系数由通信拓扑邻接矩阵决定:

78、编队闭环稳定性由终端反馈增益k满足保证dp=d+p,λi(*)为矩阵特征值,通过局部最优驱动全局编队一致;ail为通信拓扑邻接矩阵的第 (i,l) 个元素, ail=1表示车辆i可接收车辆 l 的假设轨迹信息;、 分别为车辆i及其邻居车辆 l在弧长s处的假设轨迹状态向量; 为车辆i与 l之间的期望弧长间距向量;ni为车辆i的邻居集合;为通信拓扑邻接矩阵, 为增广入度矩阵,其中d为入度矩阵,p为牵引矩阵;λi(*)为矩阵特征值,δ为保证稳定裕度的正数,0<δ<1;

79、步骤s42、下层构建牵引车-挂车协同差动铰接调节器;上层mpc求解输出的最优轨迹中的铰接角参考值作为被控量参考输入;调节器以左右轮滑移率差u=δs为控制输入,以铰接角跟踪误差、铰接角速度、牵引车与挂车横摆角速度差为被控量;其中为步骤s23中定义的前馈稳态期望铰接角,在步骤s3代价函数中作为铰接角跟踪基准,s42以此基准的优化结果作为参考输入;

80、铰接调节器的状态空间形式为,下标表示铰接调节器相关矩阵:

81、

82、其中,,为状态向量对时间导数, 为铰接角, 为铰接角速度,为牵引车与挂车横摆角速度差;w为牵引车-挂车横摆耦合扰动,;通过线性矩阵不等式lmi求解输出反馈控制器,保证闭环系统从扰动到被控输出的增益小于给定值; 为左右轮滑移率差控制输入;ah为铰接调节器状态矩阵,bh1为扰动输入矩阵,bh2为控制输入矩阵,ch为铰接调节器输出矩阵,dh11为扰动直接传递矩阵,dh12 为控制直接传递矩阵,下标 h表示铰接调节器相关矩阵;通过lmi求解输出反馈控制器,使闭环系统从扰动w到被控输出z的增益小于给定值;

83、同轴左右轮施加等大反向制动力fb,l、fb,r,产生校正横摆力矩mz的同时不产生整车纵向减速度:

84、

85、式中b为轮距,fb,l、fb,r分别为同轴左右轮的制动力,mz为产生的校正横摆力矩,fx,brake为整车纵向制动力;当左右轮制动力等大反向时,fb,r=-fb,l,fx,brake=0;

86、由此推导差动制动等效控制修正量:

87、

88、其中kδ、ka为对应的转换增益;差动制动产生的附加纵向减速度由上层速度控制器实时补偿; δδbrk、δax,brk分别为等效转向修正量与等效纵向加速度修正量;

89、差动制动执行效应通过三个维度反馈至下一周期上层mpc:其一,将制动引起的纵向速度、铰接角、横摆角速度变化量作为状态修正量,更新步骤s31的优化初始状态;其二,将差动制动占用的纵向轮胎力增量代入轮胎附着椭圆约束,修正横向力可用上限;其三,将总纵向制动力作为已知扰动量嵌入纵向动力学前馈,由上层速度控制器提前补偿;

90、步骤s43、采用铰接角-铰接角速度相平面法划分稳定域,设置稳定区、预警区、危险区三级失稳阈值,通过约束裕度、惩罚权重双通道向上层反馈,量化映射至s24的稳定裕度调节系数与s32的铰接惩罚权重qγ、横摆摆振惩罚权重kω;

91、稳定区:且:下层不干预,上层全性能优化;β取标称值βnom,qγ、kω取标称权重;

92、预警区:且:下层向上层反馈收紧约束边界与放大稳定权重,随铰接角偏差线性收窄,qγ、kω随铰接角偏差线性增大,具体映射关系为:

93、

94、其中kβ、kq为调节增益,取值范围为(0,1);βnom为稳定裕度标称值,γsafe为铰接角安全阈值,γwarn为铰接角预警阈值,qγ,nom为铰接惩罚权重标称值;

95、危险区:下层直接启动差动制动干预,重构跟车反馈增益,同时强制上层降速;β收窄至最小值βmin,qγ、kω放大至标称值的3~5倍,优先保障行驶稳定性;

96、步骤s44、控制输出合成与执行:最终控制输出按如下方式合成:

97、基准层为上层mpc反馈控制量;为上层mpc最优前轮转角,为上层mpc最优纵向加速度;

98、前馈补偿层为步骤s23的多维度道路线形前馈补偿量,以加法方式叠加至基准层;δff为前馈补偿转向量,ax,ff为前馈补偿纵向加速度;

99、安全修正层为下层差动制动修正量,在预警区和危险区以加权方式叠加,权重由步骤s43的三级失稳阈值决定;为差动制动转向修正量,为差动制动纵向加速度修正量;

100、合成转向指令δcmd以及合成纵向加速度指令ax,cmd为:

101、其中λbrk为步骤s43确定的制动干预权重,稳定区为0,预警区线性增大,危险区为1;

102、经执行器物理限幅与变化率限幅后,输出至转向系统、驱动系统与制动系统,完成最终控制执行;abs防抱死系统具有最高优先级,当下层调节器的制动指令导致任一车轮滑移率超过abs触发阈值时,该轴制动指令由abs接管,调节器保留未触发abs的车轴的制动权限,确保制动安全;其中, δ为前轮转角控制量,δmax为最大允许前轮转角;ax为纵向加速度控制量,ax,min和ax,max分别为纵向加速度的下限即最大制动减速度与上限即最大加速能力。

103、在一较佳的实施例中,编队采用plf/tpl可切换通信拓扑,目标函数中的邻居协同误差项根据当前通信拓扑选择对应邻居车辆,通过局部最优驱动全局编队一致性。

104、本发明还提供了一种复杂道路线形下自动驾驶半挂卡车编队控制优化系统,包括处理器、存储器和总线,所述存储器存储有所述处理器执行的机器可读指令;当系统运行时,所述处理器与所述存储器之间通过总线通信,所述机器可读指令被所述处理器执行时如所述的一种复杂道路线形下自动驾驶半挂卡车编队控制优化方法。

105、与现有技术相比,本发明具有以下有益效果:

106、(1)本发明提出空间域弧长建模方法,基于链式法则将时间域模型转换至弧长坐标系,道路线形参数显式嵌入整条前瞻约束序列,消除弯坡场景时间域耦合偏差,大幅提升编队轨迹跟踪一致性。

107、(2)本发明构建多维度道路曲率前置补偿机制,从编队车速、牵引车转向、铰接稳态三重维度提前抵消曲率扰动,从源头降低铰接折叠、挂车摆振风险,大幅减轻反馈控制器负担,实现失稳风险前置防控。

108、(3)本发明采用曲率幅值+曲率变化率双输入多输出模糊自适应机制,同步调节预测长度、稳定权重、约束裕度,兼顾直道算力效率与弯道安全性能,优于传统单维度自适应方案。

109、(4)本发明规范定义预测、假设、最优三类轨迹并配套完整生成、交互、滚动迭代逻辑,假设轨迹作为分布式编队标准化交互载体,解决了多车协同信息交互不规范、基准不统一的缺陷。

110、(5)本发明实现动力学模型与全部非线性稳定约束同步泰勒线性化,搭配铰接投影矩阵降维,有效降低车载求解耗时;约束分级松弛机制保证绝对安全边界全程不放松,极端工况下控制不失效。

111、(6)本发明设计上下双向协同架构与牵引-挂车分轴差动制动机制,针对两类半挂专属失稳工况差异化兜底,下层稳定状态可反向调控上层优化可行域,形成双重安全闭环。

112、(7)本发明基于离散黎卡提方程求解终端权重,配合分段李雅普诺夫函数完成全工况闭环稳定证明,控制器参数具备量化整定依据,工程落地性强;动态风阻模型实现弯坡稳向的动态平衡。