考虑滑移的无人履带车自适应路径跟踪控制策略

doi:10.3901/JME.2024.24.211

机械工程学报 ›› 2024, Vol. 60 ›› Issue (24): 211-225.doi: 10.3901/JME.2024.24.211

扫码分享

考虑滑移的无人履带车自适应路径跟踪控制策略

吴洋^1,2, 王聪¹, 董国新³, 曾日芽⁴, 曹恺⁵, 曹东璞¹

1. 清华大学车辆与运载学院北京 100084;
2. 中南大学机电工程学院长沙 410083;
3. 北京科技大学机械工程学院北京 100083;
4. 中国北方车辆研究所北京 100072;
5. 东风悦享科技有限公司武汉 430056

收稿日期:2023-12-21 修回日期:2024-10-13 出版日期:2024-12-20 发布日期:2025-02-01
作者简介:吴洋，男，1989年出生，博士，讲师。主要研究方向为车辆动力学、非道路自动驾驶、整车智能控制等。E-mail：yangwu@csu.edu.cn;曹东璞(通信作者)，男，1978年出生，博士，教授，博士研究生导师。主要研究方向为自动驾驶决策、规划与控制。E-mail：dongpu.cao@tsinghua.edu.cn
基金资助:
企业能力建设课题资助项目(20YW016)。

Slip-aware Adaptive Trajectory Tracking Control Strategy for Autonomous Tracked Vehicle

WU Yang^1,2, WANG Cong¹, DONG Guoxin³, ZENG Riya⁴, CAO Kai⁵, CAO Dongpu¹

1. School of Vehicle and Mobility, Tsinghua University, Beijing 100084;
2. The College of Mechanical and Electrical Engineering, Central South University, Changsha 410083;
3. School of Mechanical Engineering, University of Science and Technology Beijing, Beijing 100083;
4. China North Vehicle Research Institute, Beijing 100072;
5. Dongfeng USharing Technology Co., Ltd., Wuhan 430056

Received:2023-12-21 Revised:2024-10-13 Online:2024-12-20 Published:2025-02-01

摘要/Abstract

摘要： 履带车由于工作环境多变、履带-地面接触机理复杂等因素，通常难以建立准确的动力学模型。此外，受到非结构化路面的起伏扰动冲击，难以通过低成本的传感器实现准确的速度测量，这些不利因素对履带车的路径跟踪控制带来了挑战。针对动力学建模困难的问题，建立以履带转动加速度为虚拟控制输入的动力学-运动学混合模型，利用广义扰动来描述履带滑移引起的不确定性。针对速度测量困难的问题，以混合模型为基础设计了基于扩展状态估计(Extended state observer，ESO)的速度与广义扰动观测器，实现了仅依赖GNSS和履带转动编码器信息的整车状态估计。最后，以履带转动加速度为中间控制量，设计了具有抗扰能力的分层控制策略，包括上层路径跟踪控制器和下层履带转速控制器。仿真和试验结果表明，所提出的状态观测与控制策略能够准确估计履带车的实时速度，并有效提高在外部扰动下的履带车路径跟踪精度。

关键词: 无人履带车, 路径跟踪, 自抗扰控制, 状态观测

Abstract: Due to the variable working environment and complex track-ground contact mechanism, it is difficult to establish an accurate dynamic model for tracked vehicles. Moreover, affected by the drastic impulse from the unstructured road surface, the accurate information of velocity is usually difficult or costly to measure. These unfavorable factors bring challenges to the trajectory tracking control of tracked vehicles. Aiming at the difficulty in modeling dynamics, a hybrid kino-dynamic model with track rotation acceleration as virtual control input is established, and generalized disturbances are used to describe the uncertainty caused by track slip. To deal with the unmeasurable velocity information, an extended state observer (ESO) is designed based on the hybrid model, and the state estimation of the whole vehicle is realized using only GNSS signals and track encoder signals. Finally, taking the rotational acceleration of the track as the intermediate control input, a hierarchical disturbance-rejecting control strategy consisting of an upper layer path tracking controller and a lower layer track speed controller is designed. Simulation and test results show that the proposed state observation and control strategy can accurately estimate the real-time velocity of the tracked vehicle, and effectively improve the path tracking accuracy under external disturbances.

Key words: autonomous tracked vehicle, trajectory tracking, active disturbance rejecting control, state observation

中图分类号:

TG156

吴洋, 王聪, 董国新, 曾日芽, 曹恺, 曹东璞. 考虑滑移的无人履带车自适应路径跟踪控制策略[J]. 机械工程学报, 2024, 60(24): 211-225.

WU Yang, WANG Cong, DONG Guoxin, ZENG Riya, CAO Kai, CAO Dongpu. Slip-aware Adaptive Trajectory Tracking Control Strategy for Autonomous Tracked Vehicle[J]. Journal of Mechanical Engineering, 2024, 60(24): 211-225.

参考文献

[1] 熊璐，杨兴，卓桂荣，等. 无人驾驶车辆的运动控制发展现状综述[J]. 机械工程学报，2020，56(10)：127-143. XIONG Lu，YANG Xing，ZHUO Guirong，et al. Review on motion control of autonomous vehicles[J]. Journal of Mechanical Engineering，2020，56(10)：127-143.
[2] HUANG P，ZHANG Z，LUO X，et al. Path tracking control of a differential-drive tracked robot based on look-ahead distance[J]. IFAC-PapersOnLine，2018，51(17)：112-117.
[3] LI Z，CHEN L，ZHENG Q，et al. Control of a path following caterpillar robot based on a sliding mode variable structure algorithm[J]. Biosystems Engineering，2019，186：293-306.
[4] LI Z，DENG J，LU R，et al. Trajectory-tracking control of mobile robot systems incorporating neural-dynamic optimized model predictive approach[J]. IEEE Transactions on Systems，Man，and Cybernetics：Systems，2016，46(6)：740-749.
[5] QIN Z，CHEN L，FAN J，et al. An improved real-time slip model identification method for autonomous tracked vehicles using forward trajectory prediction compensation[J]. IEEE Transactions on Instrumentation and Measurement，2021，70：1-12.
[6] ZENG R，KANG Y，YANG J，et al. Learning-based terrain identification with proprioceptive sensors for mobile robots[J]. IEEE Transactions on Industrial Electronics，2021，68(9)：8433-8443.
[7] SUBARI M A，HUDHA K，KADIR Z A，et al. Path following control of tracked vehicle using modified sup controller optimized with particle swarm optimization (PSO)[J]. International Journal of Dynamics and Control，2022，10(5)：1461-1470.
[8] 胡家铭，胡宇辉，陈慧岩，等. 基于模型预测控制的无人驾驶履带车辆轨迹跟踪方法研究[J]. 兵工学报，2019，40(3)：456-463. HU Jiaming，HU Yuhui，CHEN Huiyan，et al. Research on trajectory tracking of unmanned tracked vehicles based on model predictive control[J]. Acta Armamentarii，2019，40(3)：456-463.
[9] MARTINEZ J L，MORALES J，MANDOW A，et al. Inertia-based ICR kinematic model for tracked skid-steer robots[C]//2017 IEEE International Symposium on Safety，Security and Rescue Robotics (SSRR). Shanghai，China：IEEE，2017：166-171.
[10] ZHAO Z，LIU H，CHEN H，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.
[11] TIAN Y，YAO Q，HANG P，et al. Adaptive coordinated path tracking control strategy for autonomous vehicles with direct yaw moment control[J]. Chinese Journal of Mechanical Engineering，2022，35(1)：1.
[12] ZOU T，ANGELES J，HASSANI F. Dynamic modeling and trajectory tracking control of unmanned tracked vehicles[J]. Robotics and Autonomous Systems，2018，110：102-111.
[13] 侯宇涵，翟丽，张雪莹. 双侧电机驱动履带车辆操纵稳定性与轨迹跟踪综合控制[C]//2020中国汽车工程学会年会暨展览会. 中国上海，2020：351-356. HOU Yuhan，ZHAI Li，ZHANG Xueying. Handling stability and trajectory tracking integrated control of dual-motor driven tracked vehicle[C]// China-SAE Congress and Exhibition，Shanghai，China. 2020：351-356.
[14] SABIHA A D，KAMEL M A，SAID E，et al. ROS-based trajectory tracking control for autonomous tracked vehicle using optimized backstepping and sliding mode control[J]. Robotics and Autonomous Systems，2022，152：104058.
[15] KAYACAN E，YOUNG S N，PESCHEL J M，et al. High-precision control of tracked field robots in the presence of unknown traction coefficients[J]. Journal of Field Robotics，2018，35(7)：1050-1062.
[16] RIGATOS G. A Nonlinear optimal control approach for tracked mobile robots[J. Journal of Systems Science and Complexity，2021，34(4)：1279-1300.
[17] SALGADO I，CRUZ-ORTIZ D，CAMACHO O，et al. Output feedback control of a skid-steered mobile robot based on the super-twisting algorithm[J]. Control Engineering Practice，2017，58：193-203.
[18] YUE M，WANG L，MA T. Neural network based terminal sliding mode control for WMRs affected by an augmented ground friction with slippage effect[J]. IEEE/CAA Journal of Automatica Sinica，2017，4(3)：498-506.
[19] TANG Z，LIU H，ZHAO Z，et al. Trajectory tracking of unmanned tracked vehicle based on model-free algorithm for off-road driving conditions[C]//2021 IEEE International Conference on Unmanned Systems (ICUS). 2021：8.
[20] RIOS J D，ALANIS A Y，LOPEZ-FRANCO M，et al. Real-time neural identification and inverse optimal control for a tracked robot[J]. Advances in Mechanical Engineering，2017，9(3)：1-18.
[21] JUMAN M A，WONG Y W，RAJKUMAR R K，et al. An incremental unsupervised learning based trajectory controller for a 4 wheeled skid steer mobile robot[J]. Engineering Applications of Artificial Intelligence，2019，85：385-392.
[22] 康翌婷，张煜，曾日芽. 地面不平条件下考虑滑动转向特性的履带车辆路径跟踪控制[J]. 中南大学学报(自然科学版)，2022，53(2)：491-501. KANG Yiting，ZHANG Yu，ZENG Riya. Path tracking control of tracked vehicles considering skid-steer characteristics on uneven terrain[J]. Journal of Central South University (Science and Technology)，2022，53(2)：491-501.
[23] XIAO B，CAO L，XU S，et al. Robust tracking control of robot manipulators with actuator faults and joint velocity measurement uncertainty[J]. IEEE/ASME Transactions on Mechatronics，2020，25(3)：1354-1365.
[24] PENG Z，WANG J. Output-feedback path-following control of autonomous underwater vehicles based on an extended state observer and projection neural networks[J]. IEEE Transactions on Systems，Man，and Cybernetics：Systems，2018，48(4)：535-544.

考虑滑移的无人履带车自适应路径跟踪控制策略

Slip-aware Adaptive Trajectory Tracking Control Strategy for Autonomous Tracked Vehicle

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	侯旭朝, 马越, 项昌乐. 电驱动履带车辆转向稳定性控制研究[J]. 机械工程学报, 2024, 60(8): 233-244.
[2]	张昊, 魏超, 胡纪滨, 陈泳丹. 基于转向模式切换的三轴独立转向车辆路径跟踪控制研究[J]. 机械工程学报, 2024, 60(2): 243-251.
[3]	汪洪波, 周俊涛, 陈无畏, 郑文杰, 谢有浩. 基于转向/横摆纳什博弈的智能车辆路径跟踪协调控制[J]. 机械工程学报, 2024, 60(10): 439-452.
[4]	朱威霖, 王超, 邓文翔, 梁相龙, 姚建勇. 基于非奇异终端滑模的电机伺服系统预设性能控制[J]. 机械工程学报, 2023, 59(24): 359-366.
[5]	莫舒然, 张宏伟, 王新环. 基于ADRC与SMO的涡旋压缩机低速转矩补偿控制^*[J]. 电气工程学报, 2023, 18(2): 9-15.
[6]	林歆悠, 叶卓明, 周斌豪. 基于DQN强化学习的自动驾驶转向控制策略[J]. 机械工程学报, 2023, 59(16): 315-324.
[7]	沈伟, 袁小康, 刘明. 基于事件触发和扩展状态观测器的液压位置跟踪系统控制研究[J]. 机械工程学报, 2022, 58(8): 274-284.
[8]	向红标, 程旭, 李梦伟, 王收军, 张冕, 黄显, 霍文星. 磁弹性微型游泳机器人在外部干扰和复杂路径下的精确跟踪控制[J]. 机械工程学报, 2022, 58(7): 93-102.
[9]	刘鹏涛, 汪首坤, 王军政, 雷涛, 法炜, 韩中华. 震源车无人驾驶控制算法设计与应用[J]. 机械工程学报, 2022, 58(6): 211-220.
[10]	王振业, 王久和, 张梦壕. 多变换器系统无源控制策略研究^*[J]. 电气工程学报, 2022, 17(1): 63-70.
[11]	郑怀航, 王军政, 刘冬琛, 汪首坤. 融合前馈与姿态预测的并联稳定平台自抗扰控制策略[J]. 机械工程学报, 2021, 57(9): 19-27.
[12]	梁艺潇, 李以农, KHAJEPOUR Amir, 郑玲. 基于转向与主动横摆力矩协调的四轮驱动智能电动汽车路径跟踪控制[J]. 机械工程学报, 2021, 57(6): 142-155.
[13]	王金健, 徐晖, 祝长生. 多跨转子系统多频传递力变步长神经网络控制[J]. 机械工程学报, 2021, 57(4): 10-20.
[14]	刘春强, 骆光照, 涂文聪. 航空机电作动永磁同步电机自抗扰控制研究综述^*[J]. 电气工程学报, 2021, 16(4): 12-24.
[15]	江献良, 陈凌宇, 郑杰基, 谭若愚, 李宝宇, 范大鹏. 基于数字孪生模型的直驱部件高精度控制方法[J]. 机械工程学报, 2021, 57(17): 98-109.