重型特种装备车辆多轴协调速度控制方法研究

菊 睿,李孝全,刘海平,张佳丽,张文博

(空军工程大学 防空反导学院,西安 710051)

摘要:针对重型特种装备的停车定位对驾驶员的驾驶技术要求较高、有些场景需要驾驶员和指挥员协同工作、车辆的行驶轨迹偏移会导致效率低下以及车辆能耗增加的问题,提出了重型特种装备车辆多轴协调速度控制方法,合理控制车辆多轴协调运动轨迹,降低车辆能源消耗。通过获取车辆虚拟主轴运动的速度与加速度作为约束条件,采用三次样条插值法建立车辆虚拟主轴和从轴间的传动关系模型;以约束条件和传动关系模型为基础,结合S形速度控制算法,设计车辆多轴协调运动最优速度控制模型,实现车辆多轴协调速度控制。仿真结果表明,所提方法可有效控制车辆主轴与从轴的位移、速度与角度,有效控制车辆多轴协调周期性,与理想参数差距较小,控制精度较高;可降低车辆的能源消耗,提升车辆综合效率。

关键词:重型特种装备;车辆多轴协调;速度控制;B样条曲线;虚拟主轴;电子凸轮

0 引言

重型特种装备车辆的用途是运输单体超长、超重货物,在军用与民用领域均有应用,具备较优的越野性能与机动性能[1-3],在各种恶劣道路状况下,均可安稳运输货物。但重型特种装备车辆的车体较大,增加了车辆的能耗[4-5],通过研究车辆多轴协调运动轨迹,可有效控制车辆多轴协调运动的位置与速度等相关参数,确保车辆低能耗要求。

罗锦才等[6]以增强学习为基础,设计车辆运动轨迹控制方法,通过三角函数获取轮胎的作用力,以拟合方式得到车辆漂移数据与侧向力,以车辆漂移为目标函数,塑造车辆动力模型,将其变更成2自由度系统,该系统为线性的,通过增强学习法获取该系统内最优控制策略,实现车辆运动轨迹控制,该方法可有效控制车辆运行轨迹,控制效果稳定性较优;杨波等[7]依据规则分配扭矩的思想,设计车辆运动轨迹控制方法,该方法可合理分配车辆扭矩,完成车辆运动轨迹控制,提升车辆驱动系统效率,降低能耗。但是这2种方法均只能实常规车辆的能耗控制,在重型特征装备车辆中,效果较差。

本文中为了能更好地解决非线性关系下的重型特种装备车辆的能耗问题,设计一种最优速度控制模型。研究重型特种装备车辆多轴协调速度控制,达到可降低车辆的能源消耗,提升车辆综合效率的目的。

1 重型特种装备车辆多轴协调运动轨迹

1.1 重型特种装备车辆多轴动力传动能耗问题分析

本文中首先要分析车辆的多轴传动结构,通过分析构造更好地了解能耗的问题。重型特种装备车辆多轴驱动的动力传动系统结构如图1所示。

图1 动力传动系统结构
Fig.1 Powertrain structure

重型特种装备车辆多轴驱动动力传动系统将发动机输出的扭矩,经由变速器、差速器、分动器与驱动桥,传输到车轮,实现车轮的转动[8-10],变速箱由更改挡位实现其输入输出转速与扭矩的变更,符合繁琐行驶轨迹需求。分动器的作用是依据分扭比为每个驱动桥分配扭矩。差速器的作用是控制两侧驱动轮按照不同角速度运转,完成驱动轮与地面间的纯运转,形成较多的驱动力,加强重型特种装备车辆的机动性。多轴驱动速度合理性是产生能耗的主要部分。

1.2 约束条件计算

通过分析重型特种装备车辆结构,可以看出:车辆多轴传动的速度是否合理,是决定能耗的主要原因。通常学者研究的都是线性曲线的重型特种装备车辆多轴协调速度控制。但在实际的车辆运行条件下,多数车辆是会产生非线性轨迹,非均匀三次B样条曲线,结构简单,使用灵活,得到了广泛的应用。B-spline曲线具备较优的局部控制效果,因此,本文选择非均匀三次B样条曲线,设计传动关系模型。在这之前需要计算约束条件:

车辆多轴传动关系的B-spline曲线表达为:

(1)

其中:车辆多轴传动关系的对应顶点是gi(i=0,1,…,n);k次规范B样条基函数是Ni,k(e);节点矢量的非递减参数是e;e的序列是E:e0e1≤…≤ei+k+1,通过U获取k次车辆多轴传动关系的分段多项式。

B-spline曲线的递推公式为:

(2)

eieei+1时,Ni,0(e)=1,否则,Ni,0(e)=0。

通过式(2)可获取不同次数时的B-spline曲线表达式。分析重型特种装备车辆多轴传动关系时,需同时考虑车辆的速度与加速度等约束条件,并递推传动关系为:

(3)

其中,l=1,2,…,k; j=i-k+1,…,i

重型特种装备车辆多轴传动关系分析时,速度与加速度为不间断的,因此选取三次B样条曲线展开插值,获取车辆多轴协调传动关系控制顶点的一阶导数:

(4)

其中,插值系数是λ,根据人工经验设定,一般为1。车辆多轴协调传动关系的控制顶点的二阶导数:

(5)

结合式(3)—式(5)可获取重型特种装备车辆多轴协调运动时的速度与加速度作为约束条件:

(6)

(7)

车辆多轴协调运动时需符合的速度约束条件:

|q1(e)|=|v(e)|≤vmax

(8)

其中,符合车辆多轴协调运动需求的最大速度是vmax。车辆多轴协调运动时需符合的速度约束条件为:

|q2(e)|=|a(e)|≤amax

(9)

1.3 车辆多轴间的传动关系模型计算

重型特种装备车辆多轴传动关系属于非线性运动,电子凸轮能够在主轴与从轴间完成非线性传动[11],与重型特种装备车辆多轴协调运动形式相同,为此,依据电子凸轮的虚拟主轴与从轴的传动原理[12-13],建立重型特种装备车辆多轴传动关系模型。

利用三次样条插值法(三次样条插值是通过一系列形值点的一条光滑曲线,数学上通过求解三弯矩方程组得出曲线函数组的过程。实际计算时还需要引入边界条件才能完成计算。一般的计算方法都没有说明非扭结边界的定义,但数值计算软件如Matlab都把非扭结边界条件作为默认的边界条件。)构造虚拟主轴和从轴间的传动关系模型;三次样条插值电子凸轮表内,代表车辆多轴协调运动轨迹的数个控制顶点,确保表内运动轨迹控制顶点位置存在二阶不间断导数,运动轨迹控制顶点间的区间是三次多项式,因此,建立获取的三次样条插值多项式函数h(g),对于电子凸轮表模型存在以下关系:h(g)在虚拟主轴各运动轨迹控制顶点间的区间Ii=[gi-1,gi]内均为三次多项式,h(g)在全区间[x0,xn]内存在2次不间断导数,针对随机运动轨迹控制顶点,其传动关系式为:

(10)

其中:车辆从轴位置是yi;车辆主轴位置是gi;前插系数是λ′;后插系数是λ″;h(g)的一阶导数是h′(g);h(g)的二阶导数是h″(g)。

1.4 车辆多轴间的传动关系模型计算

依据1.2小节获取的约束条件和1.3小节获取的车辆多轴传动关系参数,利用S形速度控制算法得到最优速度控制模型。

S形速度控制算法是对重型特种装备车辆多轴运动不同阶段的速度进行控制。

1) 车辆不同轴最大速度控制

在车辆运动处于加加速段o1时,需确保车辆主轴运动通过o1后,其他轴速度需小于最大设置速度F,因为o1能够直接决定减加速段o3,所以需保证当前车辆主轴运动速度经过o3后的速度低于F[14]

令车辆主轴运动处于o1的某个周期时,其当下加速度是a,速度是v,通过1.2小节获取,进入o3后,经过第i′周期,车辆不同轴运动的相互关系为::

(11)

其中,o3的周期数是b3,则结束后处于的最大速度vmax为:

(12)

通过式(13)可求解o1内随机周期内车辆多轴运动可达到的vmax,当下一周期符合vmax>F,那么进入o3,通过S形速度控制算法可确保车辆多轴运动达到vmax后保持不变。

2) 车辆多轴运动的减速控制

通过提前减速的方式,确保车辆精准停至目标位置,车辆多轴运动减速处理的重点是:多轴运动速度曲线离散化后[15],精准求解减速距离L,就是分析车辆多轴运动速度控制的各周期中,L和剩余距离Lγ的大小,令车辆多轴运动减速段的周期数是b5b6b7,分别对应加减速段o5、匀减速段o6、减减速段o7

利用1.2小节重新求解车辆多轴运动进入o5时的加速度a′,依据式(13)获取的vmax求解o5结束后,第b5个周期时,车辆多轴运动的加速度、速度与运行距离为:

ab5(e)=-a′(eb5

(13)

(14)

(15)

b6个周期时,车辆多轴运动的加速度、速度与运行距离为:

ab6(e)=ab5(e)

(16)

vb6(e)=vb5(e)+ab5(eb6

(17)

(18)

b7个周期时,车辆多轴运动的加速度、速度与运行距离为:

ab7(e)=-a′(eb7

(19)

(20)

(21)

结合式(16)、式(19)、式(22)获取,车辆多轴运动处于减速段时的运行距离即减速段距离为:

L=Lb5+Lb6+Lb7

(22)

车辆多轴运动的减速距离既包含L,还包含减加速段距离L3,通过求和式(12)获取车辆多轴运动进入o3时的L3为:

(23)

因此,车辆多轴运动减速段的距离是L′=L+L3。通过控制L′实现重型特种车辆多轴运动的减速处理。通过S形速度控制算法实现车辆多轴运动的最大速度处理与减速处理,完成车辆多轴运动的最优速度控制。

2 测试实验及结果分析

2.1 实验模拟环境建立

以某重型特种装备车辆为实验对象,该车辆的发动机是高速四冲程的8缸发动机;分动器包含高低档,重型特种装备车辆行驶过程中使用高档;差速器选择对称式圆锥行星齿轮差速器;变速器由固定轴式主变速器和行星轮式变速器构建而成。利用本文方法控制该车辆多轴协调运动轨迹,验证本文方法多轴协调运动轨迹的控制效果。实验模拟环境如图2所示。

图2 实验模拟环境
Fig.2 Experimental simulation environment

2.2 Trucksim软件计算参数

选定车型开始在Trucksim中建立整车模型。详细参数计算后设置如表1所示。

表1 整车建模仿真基本尺寸
Table 1 Basic dimensions of vehicle modeling and simulation

名称符号值单位簧载质量M8 000kgx-轴惯量半径Rx0.716my-轴惯量半径Ry2.819mz-轴惯量半径Rz2.795m侧倾惯量Ixx4 101.2kg·m2滚动惯量Iyy63 574.1kg·m2转向惯量Izz62 496.2kg·m2参数Ixy0kg·m2参数Ixz1 626kg·m2参数Iyz0kg·m2刚度测定位置纵向S15 000mm刚度测定位置横向S21 000mm扭转节点位置S33 000mm引擎支撑S40mm纵轴刚度K1 000Nm/deg纵轴阻尼C100Nm/deg/sec

设置实验初始参数,具体参数表2所示。

表2 实验参数初始设置
Table 2 Initial setting of experimental parameters

序号参数设置值1n5个2k10次3vmax200 km/h4λ15步长0.05

设定车辆规定轨迹,其轨迹如图3所示。

图3 车辆规定轨迹图
Fig.3 Vehicle prescribed trajectory map

2.3 利用Simulink仿真实验

利用Simulink进行车辆多轴协调运动轨迹控制的仿真实验,Simulink是Matlab仿真软件内一个图形化仿真工具,具备动态系统建模、仿真与分析功能。Simulink支持离散系统与线性系统等系统的仿真,具备可视化与开放性等优势。

利用Simulink设置该车辆多轴协调运动为周期性运动,车辆位移目标位置40 000。利用本文方法、文献[6]中的方法和文献[7]中的方法控制该重型特种装备车辆多轴协调运动轨迹,令车辆达到目标位置,该车辆主从轴的位置、速度与加速度控制结果如图4和图5所示。

图4 不同方法主轴加速度控制曲线
Fig.4 Spindle acceleration control curves of different methods

图5 不同方法从轴位置、速度与加速度控制曲线
Fig.5 Different methods to control the curve from axis position,velocity and acceleration

根据图4和图5可知,3种方法控制后的车辆主从轴位移均能达到目标位置,但是本文方法的车辆主从轴协调控制过程中,速度与加速度曲线满足S形的速度与加速度控制需求,且从轴速度与加速度的变化情况较平稳,无过多波动,同时没有突变情况发生,但是对比方法虽然到达了目标位置,但是在控制过程中,位置波动较大,并且速度与加速度的变化情况不佳,出现多次明显波动,不够平稳。实验证明:本文方法可有效控制重型特种装备车辆多轴协调运动过程中的位移、速度与加速度,其具备了有效性。

利用Simulink设置该车辆多轴协调运动为非周期性运动,车辆位移轨迹按照图3规划轨迹设置,分析3种方法在控制车辆多轴协调非周期性运动的运动轨迹,控制结果如图6所示。

图6 车辆多轴协调非周期性运动轨迹控制结果
Fig.6 Control results of vehicle multi-axis coordinated aperiodic motion trajectory

根据图6可知,本文方法可有效控制车辆多轴协调非周期性运动的运动轨迹,其控制后的运动轨迹与轨迹运动轨迹差距非常小,控制后的轨迹和规定轨迹基本一致,确保车辆达到了目标位置,但是对比方法均出现了较大的误差,其运动轨迹与规定轨迹部分重合,但是多数位置均偏离规定轨迹。实验证明:本文方法的轨迹控制最准确,其可精准控制车辆多轴协调非周期运动轨迹,有效提高了控制效果。

利用Simulink分析该车辆应用3种方法控制多轴协调运动轨迹后,车辆的综合效率、百公里油耗与节油率,分析结果如表3所示。

表3 综合效率、百公里油耗与节油率分析结果
Table 3 Analysis results of comprehensive efficiency,fuel consumption per 100 kilometers and fuel saving rate

车辆运行方式综合效率/%百公里油耗/L节油率/%周期性运动应用前79.1489.993.67文献[6]方法85.4582.374.38文献[7]方法86.7481.924.55本文方法91.3667.785.89 非周期性运动应用前61.4586.284.87文献[6]方法73.6978.625.25文献[7]方法77.5175.295.12本文方法87.4260.246.19

根据表3可知,在车辆处于周期性运动与非周期性运动时,应用本文方法后车辆的综合效率均有所提升,百公里油耗均显著下降,节油率均明显提升,文献方法在三方面也有一定幅度的提升,但是其提升幅度远远低于本文方法。实验证明:应用本文方法后,可有效降低车辆的能源消耗,提升车辆综合效率。

3 结论

依据重型特种装备车辆多轴协调动力传动系统的传动特性,研究重型特种装备车辆多轴协调运动轨迹,合理控制车辆多轴协调运动轨迹,确保车辆到达指定位置,降低车辆能源消耗。仿真实验部分,主要工作如下:

1) 仿真实验首先利用Trucksim软件计算参数。得到了整车建模的相关参数和数据。

2) 利用Simulink进行车辆多轴协调运动轨迹控制的仿真实验,令车辆达到目标位置,测量该车辆主从轴的位置、速度与加速度控制结果。

3) 通过仿真实验验证了本文方法车辆多轴协调运动轨迹控制的有效性。设计车辆多轴协调运动轨迹控制方法,可促进重型特种装备车辆的发展,扩展其应用领域。

参考文献:

[1] 南海峰,阴元罡,郭帅.某军用多轴特种汽车转向模式浅析[J].汽车实用技术,2021,46(14):169-171.

NAN Haifeng,YIN Yuangang,GUO Shuai.Analysis on the steering mode of a military multi-axle special vehicle[J].Automobile Practical Technology,2021,46(14):169-171.

[2] 刘悦,刘明磊.特种重型车辆惯性参数测量方法仿真分析[J].机械研究与应用,2020,33(2):47-51.

LIU Yue,LIU Minglei.Simulation analysis of inertial parameter measurement method for special heavy vehicles[J].Mechanical Research and Application,2020,33(2):47-51.

[3] 杜志朋,林恕锋,董明明.重型越野车辆油气弹簧设计与验证[J].液压与气动,2021,45(10):69-75.

DU Zhipeng,LIN Shufeng,DONG Mingming.Design and verification of oil and gas springs for heavy off-road vehicles[J].Hydraulics and Pneumatics,2021,45(10):69-75.

[4] 宁满旭,王三舟,巴腾跃,等.无人驾驶重型汽车AEB控制算法及仿真[J].重庆理工大学学报(自然科学),2022,36(6):72-80.

NING Manxu,WANG Sanzhou,MA Tengyue,et al. Aeb control algorithm and simulation verificationof pilotless heavy vehicle[J].Journal of Chongqing University of Technology(Natural Science),2022,36(6): 72-80.

[5] 钟恒,李广含,曾小华,等.多轴特种混动车辆工况自适应驱动力分配控制[J].中国机械工程,2019,30(5):528-534.

ZHONG Heng,LI Guanghan,ZENG Xiaohua,et al.Adaptive driving force distribution control for multi-axle special hybrid vehicle operating conditions[J].China Mechanical Engineering,2019,30(5):528-534.

[6] 罗锦才,刘暾东.基于增强学习的车辆转弯制动横向轨迹控制[J].计算机仿真,2021,38(7):107-110.

LUO Jincai,LIU Tundong.Vehicle turning braking lateral trajectory control based on reinforcement learning[J].Computer Simulation,2021,38(7):107-110.

[7] 杨波,白锦洋,李洪彪,等.多轴重型电驱车扭矩分配控制策略研究[J].西北工业大学学报,2019,37(S1):93-99.

YANG Bo,BAI Jinyang,LI Hongbiao,et al.Research on torque distribution control strategy for multi-axle heavy-duty electric drive vehicles[J].Journal of Northwestern Polytechnical University,2019,37(S1):93-99.

[8] 徐杨,陆丽萍,褚端峰,等.无人车辆轨迹规划与跟踪控制的统一建模方法[J].自动化学报,2019,45(4):799-807.

XU Yang,LU Liping,CHU Duanfeng,et al.A unified modeling method for trajectory planning and tracking control of unmanned vehicles[J].Chinese Journal of Automation,2019,45(4):799-807.

[9] 胡家铭,胡宇辉,陈慧岩,等.基于模型预测控制的无人驾驶履带车辆轨迹跟踪方法研究[J].兵工学报,2019,40(3):456-463.

HU Jiaming,HU Yuhui,CHEN Huiyan,et al.Research on trajectory tracking method of unmanned tracked vehicle based on model predictive control[J].Journal of Ordnance Engineering,2019,40(3):456-463.

[10]孙秦豫,付锐,王畅,等.人机协作系统中车辆轨迹规划与轨迹跟踪控制研究[J].中国公路学报,2021,34(9):146-160.

SUN Qinyu,FU Rui,WANG Chang,et al.Research on vehicle trajectory planning and trajectory tracking control in human-robot collaborative system[J].Journal of China Highway,2021,34(9):146-160.

[11]何德峰,徐广琪,李海平.自主车辆高效滚动时域轨迹规划与跟踪控制[J].浙江工业大学学报,2021,49(1):16-23,81.

HE Defeng,XU Guangqi,LI Haiping.Efficient rolling time domain trajectory planning and tracking control of autonomous vehicles[J].Journal of Zhejiang University of Technology,2021,49(1):16-23,81.

[12]顾曹源,朱俊威,张文安,等.网络化多轴运动控制系统的容侵同步控制[J].控制与决策,2019,34(11):2289-2296.

GU Caoyuan,ZHU Junwei,ZHANG Wenan,et al.Intrusion-tolerant synchronous control of networked multi-axis motion control system[J].Control and Decision,2019,34(11):2289-2296.

[13]吴言穗,王瑶为,俞立,等.多轴运动控制系统的非线性PID交叉耦合控制[J].控制工程,2020,27(5):830-834.

WU Yansui,WANG Yaowei,YU Li,et al.Nonlinear PID cross-coupling control of multi-axis motion control system[J].Control Engineering,2020,27(5):830-834.

[14]胡呈祖,周军连.基于STM32+FPGA的多轴运动控制器的设计[J].机床与液压,2021,49(12):82-86.

HU Chengzu,ZHOU Junlian.Design of multi-axis motion controller based on STM32+FPGA[J].Machine Tool and Hydraulics,2021,49(12):82-86.

[15]梁忠超,张欢,赵晶,等.基于自适应MPC的无人驾驶车辆轨迹跟踪控制[J].东北大学学报(自然科学版),2020,41(6):835-840.

LIANG Zhongchao,ZHANG Huan,ZHAO Jing,et al.Trajectory tracking control of unmanned vehicles based on adaptive MPC[J].Journal of Northeastern University (Natural Science Edition),2020,41(6):835-840.

Research on the multi-axis coordinated speed control method of heavy special equipment vehicles

JU Rui, LI Xiaoquan, LIU Haiping, ZHANG Jiali, ZHANG Wenbo

(Air Defence and Anti-Missile College, Air Force Engineering University, Xi’ an 710051, China)

Abstract:The parking positioning of heavy special equipment has high requirements on the driver’s driving skills, some scenarios require the driver and the commander to work together, and the deviation of the driving trajectory of a vehicle leads to a low efficiency and an increased vehicle energy consumption. Aiming at these problems, this paper proposes a multi-axis coordinated speed control method for heavy special equipment vehicles to reasonably control the multi-axis coordinated motion trajectory and reduce vehicle energy consumption. With the obtained speed and acceleration of the virtual main shaft motion of the vehicle as the constraint conditions, the proposed control method uses the cubic spline interpolation method to establish a transmission relationship model between the virtual main shaft and the slave shaft of the vehicle. Based on the constraints and the transmission relationship model, combined with the S-shape speed control algorithm, the proposed control method designs an optimal speed control model of vehicle multi-axis coordinated motions to realize vehicle multi-axis coordinated speed control. The simulation results show that the proposed method can effectively control the displacement, speed and angle of both the main shaft and the slave shaft, and effectively control the multi-axis coordination periodicity of the vehicle, which makes a small gap with the ideal parameters and a high control accuracy. It can also reduce the energy consumption of the vehicle and improve the overall vehicle efficiency.

Key words:heavy special equipment; vehicle multi-axis coordination; speed control; B spline curve; virtual main shaft; electronic cam

本文引用格式:菊睿,李孝全,刘海平,等.重型特种装备车辆多轴协调速度控制方法研究[J].兵器装备工程学报,2023,44(6):254-260.

Citation format:JU Rui, LI Xiaoquan, LIU Haiping, et al.Research on the multi-axis coordinated speed control method of heavy special equipment vehicles[J].Journal of Ordnance Equipment Engineering,2023,44(6):254-260.

中图分类号:TH243

文献标识码:A

文章编号:2096-2304(2023)06-0254-07

收稿日期:2022-07-07;

修回日期:2022-08-29

基金项目:国家自然科学基金项目(51675530)

作者简介:菊睿(1988—),男,硕士,E-mail:423640101@qq.com。

通信作者:刘海平(1977—),男,副教授,E-mail:780264077@qq.com。

doi: 10.11809/bqzbgcxb2023.06.035

科学编辑 雷雨龙 博士(吉林大学教授、博导)

责任编辑 徐佳忆