现代制造工程 ›› 2026, Vol. 549 ›› Issue (6): 1-10.doi: 10.16731/j.cnki.1671-3133.2026.06.001

• 试验研究 •    下一篇

融合改进纯跟踪与模糊PID的履带机器人轨迹跟踪控制*

白金乐1, 权悦2, 胡俊泽1   

  1. 1 安徽科技学院智能制造学院,滁州 233100;
    2 安徽科技学院电气与电子工程学院,蚌埠 233000
  • 收稿日期:2025-09-24 出版日期:2026-06-18 发布日期:2026-07-02
  • 通讯作者: 权悦,博士,副教授,硕士研究生导师,主要研究方向为多智能体系统的故障检测与协同控制。 E-mail:1436442328@qq.com
  • 作者简介:白金乐,硕士研究生,主要研究方向为移动机器人路径规划与轨迹跟踪。
  • 基金资助:
    *安徽省教育厅自然科学研究重大项目(2024AH040061);光伏电站智能巡检与光伏板清扫综合系统研发与应用项目(882152)

Trajectory tracking control for tracked robots combining improved pure pursuit algorithm with fuzzy PID

BAI Jinle1, QUAN Yue2, HU Junze1   

  1. 1 College of Intelligent Manufacturing,Anhui University of Science and Technology, Chuzhou 233100,China;
    2 College of Electrical and Electronic Engineering,Anhui University of Science and Technology, Bengbu 233000,China
  • Received:2025-09-24 Online:2026-06-18 Published:2026-07-02

摘要: 针对履带机器人在复杂路径条件下轨迹跟踪精度和运动稳定性不足的问题,提出一种融合改进纯跟踪(Pure Pursuit,PP)与模糊比例-积分-微分(Proportional-Integral-Derivative,PID)的轨迹跟踪控制方法。改进纯跟踪算法通过路径曲率与期望速度动态优化前视预瞄距离,实现自适应预瞄控制,有效降低横向跟踪误差。结合路径曲率与终点的距离动态计算期望速度,并引入模糊推理机制实时调节PID参数,对实际速度进行修正,确保快速响应与末端平稳控制。仿真实验结果表明,相较于传统纯跟踪算法,改进纯跟踪算法平均横向跟踪误差降低了79.50 %,平均航向角误差降低了47.94 %,显著提升了履带机器人在复杂路径下的轨迹跟踪精度与运动稳定性,验证了其良好的适应性与鲁棒性。

关键词: 轨迹跟踪, 纯跟踪算法, 自适应预瞄, 模糊比例-积分-微分控制, 履带机器人

Abstract: To address the insufficient trajectory tracking accuracy and stability of tracked robots under complex path conditions, it proposes an integrated control method that combines enhanced Pure Pursuit (PP) algorithm with fuzzy PID. The Pure Pursuit algorithm is enhanced by dynamically optimizing the lead distance based on path curvature and motion velocity,enabling adaptive lead control that effectively reduces tracking errors. The desired velocity is dynamically calculated by integrating path curvature and destination distance,while a fuzzy inference mechanism adjusts PID parameters in real time to correct actual velocity,ensuring rapid response and end-point smoothness control. Simulation results demonstrate that compared to traditional pure pursuit algorithms,Pure Pursuit (PP) algorithm reduces average lateral error by 79.50 % and average heading error by 47.94 %. It significantly enhances the trajectory tracking accuracy and motion stability of tracked robots on complex paths,validating its excellent adaptability and robustness.

Key words: trajectory tracking, Pure Pursuit (PP) algorithm, adaptive pre-scoping, fuzzy Proportional-Integral-Derivative (PID) control, tracked robot

中图分类号: 

版权所有 © 《现代制造工程》编辑部 
地址:北京市东城区东四块玉南街28号 邮编:100061 电话:010-67126028 电子信箱:2645173083@qq.com
本系统由北京玛格泰克科技发展有限公司设计开发 技术支持:support@magtech.com.cn