基于时变局部LMPC的车辆主动调速路径跟踪

Active speed adjustment path tracking of vehicles based on time-varying local linear MPC

  • 摘要: 在矿山、港口、工业园区等需要频繁经过直角弯、U型弯和连续弯道等大曲率路径的场景中,车辆路径跟踪控制面临精确性、实时性与行驶效率之间的矛盾。针对该现状,提出了一种基于时变局部线性模型预测控制的主动调速路径跟踪控制方法。该方法通过引入时变局部坐标系并将车辆动力学模型在小角度假设下线性化,结合多参考点策略,解决了现有方法在大曲率路径下适应性不足的问题。为同时保障较高精确性与行驶效率,引入了基于规则的主动调速策略,根据车辆状态、路径曲率和附着极限动态调整车速,以保证路径跟踪精度和行驶效率。通过MATLAB与CarSim联合仿真以及硬件在环(Hardware-in-the-loop, HIL)测试,验证了该方法的有效性。仿真结果表明,所提方法在低速与高速工况下均能有效完成路径跟踪,最大位移误差不超过0.1271m。与恒速时变局部线性模型预测控制、主动调速全局线性模型预测控制等控制方法相比,提出的方法能够有效避免大曲率路径下的误差发散,具有较好的精确性。在HIL测试中,引入定位误差后的最大位移误差为0.1336m,表明所提方法具有一定的鲁棒性。在实时性方面,相比主动调速非线性模型预测控制,提出的方法在相同仿真工况下将最大计算时间和平均计算时间分别减少了27.95%和25.61%,表明所提方法具有较好的实时性。

     

    Abstract: In application scenarios such as mining areas, ports, and industrial parks, autonomous vehicles are required to frequently negotiate sharp turns, U-shaped curves, and continuous high-curvature paths. Under such conditions, path tracking control systems face a fundamental challenge in simultaneously ensuring tracking accuracy and driving efficiency, especially when vehicle steering capability and real-time computational resources are limited. Existing path tracking methods, particularly those based on conservative constant-speed strategies, often sacrifice driving efficiency to maintain accuracy, while methods relying on nonlinear model predictive control (NMPC) frequently suffer from excessive computational burdens in real-time applications. To address this problem, this paper proposes an active speed adjustment path tracking control method based on time-varying local (TVL) linear model predictive control (LMPC), specifically designed for large-curvature path scenarios. The proposed method introduces a time-varying local coordinate system, in which the vehicle dynamics model is reformulated and linearized under the small-angle assumption. This transformation enables the construction of a linear predictive model that remains valid over the prediction horizon, even when the vehicle traverses paths such as right-angle turns and U-shaped curves. On this basis, a multi-reference-point strategy is incorporated into the LMPC framework, allowing the controller to explicitly account for the geometric characteristics of high-curvature paths and thereby improve tracking accuracy compared to conventional single-reference-point LMPC approaches. To resolve the inherent conflict between tracking accuracy and driving efficiency, a rule-based active speed adjustment strategy is further introduced. The strategy dynamically adjusts the vehicle speed based on the current vehicle state, path curvature, and traction limits, ensuring that tracking accuracy is maintained by regulating the speed. The effectiveness of the proposed TVL-LMPC-based active speed adjustment method is validated through comprehensive MATLAB–CarSim co-simulations and Hardware-in-the-Loop (HIL) testing. Simulation results demonstrate that the proposed method can stably complete path tracking tasks under both low-speed and high-speed conditions on large-curvature paths, with a maximum displacement error not exceeding 0.1271 m. In contrast, the constant-speed TVL-LMPC, active speed-adjusted global LMPC, and active speed-adjusted NMPC exhibit error divergence when negotiating sharp turns, highlighting the superior suitability of the proposed approach in complex path scenarios. HIL tests are further conducted to evaluate the performance of the proposed method under conditions closer to practical deployment. To assess robustness against sensing uncertainty, random positioning errors of ±1 cm are introduced in accordance with the performance of typical positioning systems. Under these disturbance conditions, the maximum displacement error remains within 0.1336 m, indicating that the proposed control system maintains stable and accurate tracking performance in the presence of localization disturbances. In terms of real-time performance, under identical simulation conditions, the proposed method reduces the maximum computation time and average computation time by at least 27.95% and 25.61%, respectively, compared to active speed-adjusted NMPC, confirming its suitability for real-time implementation. Overall, the proposed TVL-LMPC-based active speed adjustment path tracking control method effectively improves tracking accuracy and real-time performance on large-curvature paths while enhancing driving efficiency. The method is particularly well-suited for autonomous vehicle applications in mining areas, ports, and industrial parks, where complex path geometries and operational efficiency are both critical.

     

/

返回文章
返回