自动驾驶履带车辆鲁棒自适应轨迹跟踪控制方法

doi:10.3969/j.issn.1000-1093.2021.06.002

摘要/Abstract

摘要： 针对野外环境中自动驾驶履带车辆轨迹跟踪控制问题，考虑建模误差、参数不确定性及外界随机强干扰，以强鲁棒性及精确跟踪为目标，提出一种基于误差符号鲁棒积分的自动驾驶履带车辆鲁棒自适应轨迹跟踪控制方法。基于拉格朗日动力学方程建立自动驾驶履带车辆的运动学与动力学耦合模型；采用自适应控制方法实现对模型的精确前馈补偿，抵消模型非线性的影响；通过误差符号鲁棒积分有效抑制外界干扰及不确定性的影响；利用Lyapunov稳定性理论证明了闭环系统的全局渐进稳定性与收敛性。对仿真结果进行了实车实验一致性验证。仿真和实验结果证明：该方法在存在建模误差、参数不确定性、外界干扰条件下，在实现自动驾驶履带车辆高精度轨迹跟踪控制的同时，具有较强的自适应和鲁棒性。

关键词: 履带车辆, 自动驾驶, 鲁棒自适应, 轨迹跟踪

Abstract: A robust adaptive trajectory tracking control approach based on robust integral of sign of error is presented for the trajectory tracking control of autonomous tracked vehicles in the field environment. In the proposed approach, the modelling errors, parametric uncertainties, and external random and strong disturbances are taken into account. A kinematic and dynamic coupling model of autonomous tracked vehicles is established based on Lagrangian dynamical equation. The feedforward compensation of the established model is realized by adaptive control approach, and the external disturbances and uncertainties can be suppressed by using the robust integral of sign of error. And then the asymptotical global stability and convergence of the closed loop system is demonstrated by Lyapunov stability theory. The simulated results were verified through real vehicle test. Simulated and experimental results show that the proposed approach can be used to realize the high accuracy trajectory tracking and insure the adaptiveness and robustness for autonomous tracked vehicles in the presence of modelling errors, parametric uncertainties and external disturbances.

Key words: trackedvehicle, autonomousdriving, robustadaptivity, trajectorytracking

中图分类号:

TJ810.2

李睿，项昌乐，王超，范晶晶，刘春林. 自动驾驶履带车辆鲁棒自适应轨迹跟踪控制方法[J]. 兵工学报, 2021, 42(6): 1128-1137.

LI Rui， XIANG Changle， WANG Chao， FAN Jingjing， LIU Chunlin. Robust Adaptive Trajectory Tracking Control Approach for Autonomous Tracked Vehicles[J]. Acta Armamentarii, 2021, 42(6): 1128-1137.

参考文献［1］

［1］

翟丽,孙逢春,谷中丽.电子差速履带车辆转向转矩神经网络PID控制［J］.农业机械学报,2009,40(2):1-5,31.ZHAI L,SUN F C,GU Z L. Neural network PID control of steering torque for electronic difference tracked vehicle［J］.Transactions of the Chinese Society for Agricultural Machinery,2009,40(2):1-5,31.(in Chinese)［2］盖江涛，黄守道，周广明，等.双电机耦合驱动履带车辆自适应滑模转向控制［J］.兵工学报，2015，36(3):405-411.GAI J T, HUANG S D, ZHOU G M, et al. Adaptive sliding mode steering control of double motor coupling drive transmission for tracked vehicle［J］.Acta Armamentarii，2015，36(3):405-411.(in Chinese)［3］曾庆含,马晓军,廖自力,等.双侧电驱动履带车辆等效条件积分滑模稳定转向控制［J］.兵工学报, 2016,37(8):1351-1358.ZENG Q H, MA X J, LIAO Z L, et al. Stable steer control of electric drive tracked vehicle based on equivalent sliding mode technique with conditional integrator［J］.Acta Armamentarii,2016,37(8): 1351-1358.(in Chinese)［4］ ZHAO Z Y, LIU H O, CHEN H Y, et al. Kinematics-aware model predictive control for autonomous high-speed tracked vehicles under the off-road conditions［J］.Mechanical Systems and Signal Processing, 2019,123:333-350.［5］ AKHIMULLAH M,HUDHA K, KADIR Z A, et al. Development of path tracking controller for an autonomous tracked vehicle［C］∥Proceedings of the 2020 16th IEEE International Colloquium on Signal Processing & Its Applications.Langkawi, Malaysia：IEEE，2020：126-130.［6］胡家铭,胡宇辉,陈慧岩,等.基于模型预测控制的无人驾驶履带车辆轨迹跟踪方法研究［J］.兵工学报,2019,40(3):456-463.HU J M, HU Y H,CHEN H Y,et al. Research on trajectory tracking of unmanned tracked vehicles based on model predictive control［J］.Acta Armamentarii,2019,40(3):456-463.(in Chinese)［7］杨福威,孟红,朱强.基于模型预测控制的履带式无人平台轨迹跟踪控制算法研究［J］.舰船电子工程,2018,38(3): 44-50.YANG F W,MENG H,ZHU Q. Research on trajectory tracking control algorithm of tracked unmanned platform based on model predictive control［J］.Ship Electronic Engineering,2018,38(3):44-50.(in Chinese)［8］程军伟，高连华，王红岩，等.履带车辆转向分析［J］.兵工学报，2007，28(9):1110-1115.CHENG J W，GAO L H，WANG H Y，et al.Analsisis on the steering of tracked vehicles［J］.Acta Armamentarii，2007，28(9):1110-1115．(in Chinese)［9］王声远，霍伟．不确定非完整动力学系统的自适应模糊滑模控制器［J］.控制理论与应用，2003，20(3):427-431.WANG S Y，HUO W.Adaptive fuzzy sliding-mode controllers of uncertain dynamic nonholonomic systems［J］.Control Theory ＆ Applications，2003，20(3):427-431.(in Chinese)［10］赵伟，赵汗青．基于模糊自整定PID的履带车辆自动驾驶系统纵向车速控制［J］.计算机应用，2018，38(增刊1):63-66．ZHAO W，ZHAO H Q．Speed control of tracked vehicle driving system based on fuzzy self-tuning PID［J］.Journal of Computer Applications，2018，38(S1):63-66.(in Chinese)［11］ BROCKETT R W. Asymptotic stability and feedback stabilization［J］. Differential Geometric Control Theory, 1983, 27:181-191.［12］付拓，毛文华，张小超，等．一种履带拖拉机自动导航转向控制方法［J］.农业工程，2018，8(1):84-88．FU T，MAO W H，ZHANG X C，et al.Steering control method of caterpillar tractor fitted with automatic navigation system［J］.Agricultural Engineering，2018，8(1):84-88.(in Chinese)［13］ DIXON W E, DE QUEIROZ M S, ZHANG F, et al. Tracking control of robot manipulators with bounded torque inputs［J］.Robotica,1999,17(2):121-129.［14］ ZHAI L, SUN T M, WANG Q N, et al. Lateral stability control of dynamic steering for dual motor drive high speed tracked vehicle［J］.International Journal of Automotive Technology,2016,17(6): 1079-1090.［15］ HUANG J, LIU Y, LIU M, et al. Multi-objective optimization control of distributed electric drive vehicles based on optimal torque distribution［J］.IEEE Access,2019,7:16377-16394.

[1]	张伟，刘辉，韩立金，刘宝帅，张勋，张万年. 混合动力履带车辆机电联合制动控制[J]. 兵工学报, 2022, 43(5): 969-981.
[2]	王博洋, 关海杰, 龚建伟, 陈慧岩, 赵卉菁. 面向异构履带车辆的统一运动规划方法[J]. 兵工学报, 2022, 43(2): 241-251.
[3]	徐保荣, 王涛, 梁梓. 基于操纵动作预测的履带车辆载荷谱编制方法与流程[J]. 兵工学报, 2022, 43(2): 252-259.
[4]	杜明刚，张金乐，张喜明，孙亚东，毛飞鸿. 履带装甲车辆空气阻力系数试验测定[J]. 兵工学报, 2021, 42(7): 1564-1568.
[5]	张杰，马晓军，刘春光，袁东，张运银. 双侧独立电驱动履带车辆反馈线性化解耦与预测行驶控制[J]. 兵工学报, 2021, 42(4): 697-705.
[6]	李春明, 吴维, 郭智蔷, 苑士华, 陈思. 履带车辆纵向与垂向耦合动力学模型及功率特性[J]. 兵工学报, 2021, 42(3): 449-458.
[7]	赵屹东, 陈慧岩, 胡家铭. 双侧独立电驱动履带车辆自动机械变速器线控换挡控制方法[J]. 兵工学报, 2021, 42(3): 459-467.
[8]	盖江涛，刘春生，马长军，沈宏继. 考虑履带滑转滑移的电驱动履带车辆转向控制[J]. 兵工学报, 2021, 42(10): 2092-2101.
[9]	邹渊，张彬，张旭东，赵志颖，康铁宇，郭玉枫，吴喆. 基于归一化优势函数的强化学习混合动力履带车辆能量管理[J]. 兵工学报, 2021, 42(10): 2159-2169.
[10]	马田，王志涛，张欣，庞大千，高晓宇. 履带车辆电传动系统减速机构热特性[J]. 兵工学报, 2021, 42(10): 2170-2179.
[11]	盖江涛，生辉，周广明，刘丽芳. 串联式混合动力履带车辆急加速工况功率平衡控制策略[J]. 兵工学报, 2021, 42(10): 2180-2188.
[12]	曾根，王伟达，盖江涛，马长军，李训明，李欢欢. 双侧电机耦合驱动履带车辆斜坡转向控制策略[J]. 兵工学报, 2021, 42(10): 2189-2195.
[13]	邹天刚，闫清东，盖江涛，侯威，王志涛，帅志斌，孙雪岩. 基于扁平电机的轻混式履带车辆综合传动方案[J]. 兵工学报, 2021, 42(10): 2233-2241.
[14]	张瑞增，龚建伟，陈慧岩，王博洋，刘海鸥. 基于无人驾驶单流传动的中型履带车辆大坡道起步控制[J]. 兵工学报, 2020, 41(8): 1590-1599.
[15]	张杰，袁东，张朋，魏曙光. 双侧电传动履带车辆模糊前馈-反馈转向控制[J]. 兵工学报, 2020, 41(8): 1688-1696.