考虑执行器延迟的无人矿卡轨迹跟踪控制研究

Trajectory Tracking Control of Unmanned Mining Trucks Considering Actuator Delay

  • 摘要: 露天矿区无人矿用自卸卡车(简称无人矿卡)运行过程中,存在执行器执行延迟大的显著特点,从而导致轨迹跟踪控制精度较低、运行稳定性较差。为此本文提出一种考虑执行器延迟的轨迹跟踪控制策略。首先,采用“一阶惯性环节+纯时滞环节”复合模型对横纵向执行器的延迟特性分别进行精确建模,以此搭建纵向动力学模型和横向轨迹跟踪运动学误差模型。在此基础上,采用横纵向控制解耦的架构,分别构建纵向模型预测控制(Model Predictive Control, MPC)与横向非线性模型预测控制(nonlinear model predictive control,NMPC)优化问题,在目标函数中引入跟踪精度、运行经济性及行驶安全性指标,同时在约束条件中考虑执行器的性能限制,以保证控制输入的可行性与系统稳定性。进一步,在解耦架构中加入预测时域内的车辆状态双向交互机制,实现横纵向控制器的协同控制。基于露天煤矿实际道路场景,选取小松930E矿用自卸车为对象,进行硬件在环(HIL)仿真实验和实车实验,并与矿区中已落地应用的实车控制器进行对比验证。其中实车实验结果表明:同一路段下本文控制器在横向误差峰值、航向角误差峰值及速度跟踪误差峰值方面分别降低61.3%、57.1%和35.1%,且在轨迹跟踪精度与运行平稳性方面均表现出明显优势,同时运行效率也间接提升约9.6%。结果验证了该控制器在实际应用中的有效性和优越性。

     

    Abstract: During the operation of unmanned mining dump trucks in open-pit mining environments, significant actuator delays are commonly observed, which lead to reduced trajectory tracking accuracy and degraded operational stability. To address this issue, a trajectory tracking control strategy that explicitly accounts for actuator delay is proposed. First, a composite model consisting of a first-order inertial element and a pure time-delay element is employed to accurately characterize the delay dynamics of both longitudinal and lateral actuators. Based on this modeling framework, a longitudinal dynamic model and a lateral trajectory-tracking kinematic error model are established. On this basis, a decoupled longitudinal–lateral control architecture is adopted, within which a longitudinal Model Predictive Control (MPC) scheme and a lateral Nonlinear Model Predictive Control (NMPC) scheme are formulated. The objective functions incorporate trajectory tracking accuracy, operational efficiency, and driving safety, while actuator performance constraints are explicitly imposed to ensure the feasibility of control inputs and overall system stability. Furthermore, a bidirectional vehicle-state interaction mechanism over the prediction horizon is introduced into the decoupled framework to achieve coordinated control between the longitudinal and lateral controllers. The proposed method is validated through both hardware-in-the-loop (HIL) simulations and real-vehicle experiments based on actual road scenarios in an open-pit coal mine, with a Komatsu 930E mining dump truck selected as the test platform. Comparative evaluations are conducted against a field-deployed onboard controller currently used in the mine. The real-vehicle experimental results indicate that, on the same road segment, the proposed controller reduces the peak lateral error, peak heading error, and peak velocity tracking error by 61.3%, 57.1%, and 35.1%, respectively. In addition, it demonstrates clear advantages in trajectory tracking accuracy and operational smoothness, while improving operational efficiency by approximately 9.6%. These results verify the effectiveness and superiority of the proposed controller in practical applications.

     

/

返回文章
返回