基于ILC−TEB的井下铲运机路径跟踪与避障算法

Path tracking and obstacle avoidance algorithm for underground load–haul–dump machines based on ILC-TEB

  • 摘要: 井下铲运机受巷道路面起伏、传感器噪声及电动机振动等引发的高频扰动影响,导致传统路径跟踪算法难以同时兼顾跟踪精度与避障能力。针对上述问题,将迭代学习控制(ILC)与时间弹性带(TEB)相结合,提出了一种基于ILC−TEB的井下铲运机路径跟踪与避障算法。针对传统的时间域ILC导致迭代失效的问题,以路径弧长为自变量,通过车辆运行轨迹进行迭代优化;针对固定增益的比例−微分(PD)型ILC难以兼顾不同曲率路段跟踪需求的问题,采用基于误差的自适应增益调节机制,根据巷道动态调整比例、微分增益,并引入二阶巴特沃斯低通滤波器作为Q滤波器以抑制高频干扰,增强算法鲁棒性;针对避障绕行导致ILC错误修正的问题,在ILC学习律中引入空间相关性衰减函数,自适应调整历史误差对当前修正的贡献权重,保障避障灵活性的同时保持ILC的收敛稳定性。仿真实验结果表明:与PID、模型预测控制(MPC)及TEB算法相比,ILC−TEB算法在直道和弯道工况下的平均横向误差和航向角误差均最低;直道工况下PID算法无法实现有效避障,弯道工况下PID,MPC算法均避障失败,而TEB与ILC−TEB算法在直道、弯道工况下均能成功避障。实车测试结果表明:面对废土堆、车辆、矿石堆3类典型障碍物,ILC−TEB算法的距障碍物峰值距离相较于TEB算法分别减小了20.1%,15.0%,22.3%,压缩了无效绕行空间,且平均横向、航向角误差分别降低了22.02%,18.80%,提升了路径跟踪精度。

     

    Abstract: Underground load–haul–dump machines are affected by high-frequency disturbances caused by roadway surface irregularities, sensor noise, and motor vibration, making it difficult for conventional path-tracking algorithms to achieve both tracking accuracy and obstacle avoidance. To address these problems, a path-tracking and obstacle-avoidance algorithm combining Iterative Learning Control (ILC) and Timed Elastic Band (TEB) was proposed. To address iteration failure in conventional time-domain ILC, path arc length was used as an independent variable for iterative optimization based on vehicle trajectories. To meet tracking requirements on sections with different curvatures, which are difficult to satisfy using fixed-gain Proportional–Derivative (PD) ILC, an error-based adaptive gain adjustment mechanism was adopted to dynamically adjust proportional and derivative gains according to roadway conditions. A second-order Butterworth low-pass filter was introduced as a Q-filter to suppress high-frequency disturbances and enhance robustness. To prevent erroneous ILC corrections caused by obstacle-avoidance detours, a spatial correlation decay function was incorporated into the ILC learning law to adaptively adjust the contribution of historical errors to current corrections, maintaining convergence stability while allowing flexible obstacle avoidance. Simulation results showed that ILC-TEB achieved lower mean lateral and heading-angle errors than PID, Model Predictive Control (MPC), and TEB under both straight and curved roadway conditions. PID failed to avoid obstacles under straight roadway conditions, and both PID and MPC failed under curved roadway conditions, whereas TEB and ILC-TEB successfully avoided obstacles under both conditions. In real-vehicle tests involving three typical obstacles—spoil heaps, vehicles, and ore piles—ILC-TEB reduced maximum distances from obstacles by 20.1%, 15.0%, and 22.3%, respectively, compared with TEB, reducing unnecessary detour space. Mean lateral and heading-angle errors decreased by 22.02% and 18.80%, respectively. These results demonstrate improved path-tracking accuracy.

     

/

返回文章
返回