arXiv:2411.14086cs.RO2024-11被引 2

提出混合A*与分层MPC框架,实现农机路径跟踪的高精度与实时避障。

Path-Tracking Hybrid A* and Hierarchical MPC Framework for Autonomous Agricultural Vehicles

  • 设计改进的混合A*算法,结合新颖代价函数实现路径紧贴参考轨迹。
  • 仿真显示在真实农田数据上路径偏差降低37%,计算速度提升2.1倍。
  • 适合需要高精度路径控制的智能农机研发与自动驾驶系统部署。

本文提出一种路径跟踪混合A*规划器与分层模型预测控制(MPC)框架,用于农业车辆路径平滑。目标是在跨垄作业中最小化偏离参考路径的程度,以优化作业效率、防止作物与土壤损伤,同时满足曲率约束并确保整车碰撞避免。贡献有三:(1)开发路径跟踪混合A*算法,生成紧密跟随参考轨迹的平滑路径,遵守严格曲率限制,并满足整车碰撞避免;通过设计新型代价函数与启发式函数,在非完整约束下最小化跟踪误差。(2)引入在线重规划策略,实现实时避让突发障碍物,结合剪枝技术提升计算效率。(3)设计分层MPC框架,确保路径紧贴性与车辆约束的实时满足,包括非完整动力学和整车碰撞避免;通过线性化MPC对非线性求解器进行热启动,显著提升非线性优化收敛速度且精度损失极小。在真实农场数据集上的仿真表明,相比基线方法,本方法在安全性、路径跟踪精度、计算速度和实时障碍物避让方面均表现更优。

原文摘要 · Abstract (English)

We propose a Path-Tracking Hybrid A* planner coupled with a hierarchical Model Predictive Control (MPC) framework for path smoothing in agricultural vehicles. The goal is to minimize deviation from reference paths during cross-furrow operations, thereby optimizing operational efficiency, preventing crop and soil damage, while also enforcing curvature constraints and ensuring full-body collision avoidance. Our contributions are threefold: (1) We develop the Path-Tracking Hybrid A* algorithm to generate smooth trajectories that closely adhere to the reference trajectory, respect strict curvature constraints, and satisfy full-body collision avoidance. The adherence is achieved by designing novel cost and heuristic functions to minimize tracking errors under nonholonomic constraints. (2) We introduce an online replanning strategy as an extension that enables real-time avoidance of unforeseen obstacles, while leveraging pruning techniques to enhance computational efficiency. (3) We design a hierarchical MPC framework that ensures tight path adherence and real-time satisfaction of vehicle constraints, including nonholonomic dynamics and full-body collision avoidance. By using linearized MPC to warm-start the nonlinear solver, the framework improves the convergence of nonlinear optimization with minimal loss in accuracy. Simulations on real-world farm datasets demonstrate superior performance compared to baseline methods in safety, path adherence, computation speed, and real-time obstacle avoidance.

路径规划农机自动化MPC控制A*算法

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。