高级检索+

无人驾驶农机曲率自适应轨迹规划与跟踪控制协同优化方法

Optimizing curvature-adaptive trajectory planning and tracking control for autonomous agricultural machinery

  • 摘要: 针对无人驾驶农机现有路径规划方法受限于规则化地块或特定场景,路径与速度规划割裂,控制精度不足且稳定性差的问题,该研究提出一种轨迹规划与跟踪控制协同优化方法。在轨迹规划方面,采用Fields2cover全覆盖路径规划方法,结合路径曲率自适应高低速切换策略和S型速度曲线规划,以生成高效的全覆盖轨迹。在跟踪控制方面,基于阿克曼转向模型设计改进型线性二次调节器(linear quadratic regulator, LQR),结合路径曲率自适应权重矩阵调节机制和目标转向角预瞄策略,以提升轨迹跟踪精度。仿真结果表明,使用改进型LQR的无人驾驶农机平均横向和航向角误差分别为0.015 m和0.005 rad,与传统LQR、预瞄LQR、纯跟踪、Stanley四类跟踪控制方法相比,平均横向误差分别降低50.0%、28.6%、21.1%和40.0%,平均航向角误差分别降低28.6%、16.7%、16.7%和64.3%。无人驾驶实车测试中改进型LQR的平均横向和航向角误差分别为0.047 m和0.018 rad,相比上述四类跟踪控制方法,平均横向误差分别降低48.9%、30.9%、13.0%和56.5%,平均航向角误差分别降低40.0%、30.8%、18.2%和71.0%。同时,改进型LQR在仿真和实车试验中的速度误差均为最低,进一步验证了该方法的有效性与稳定性。研究成果可为智能农机在复杂农田场景下的高精度轨迹规划与稳定自主作业提供技术支撑。

     

    Abstract: Unmanned agricultural machinery is often ever-increasingly demanded for intelligent farming in recent years, due mainly to the labor shortage and the high operational costs. However, several challenges are still remained on the technical solutions, including the dependence on the regular-shaped fields, separation between path and velocity planning, and low control accuracy in complex environments. In this study, an integrated system of the trajectory planning and tracking control was developed to enhance the operational performance of the unmanned agricultural machinery under the field conditions. A cooperative framework was optimized to integrate the trajectory planning with the tracking control. In the trajectory planning, the Fields2Cover library was employed to generate the full-coverage paths for the irregular fields, the multiple objective functions, swath sorting, and turning connection. An adaptive velocity switching strategy was introduced using path curvature, in order to avoid the disconnection between path and velocity planning. S-curve velocity profiling was combined with the smooth velocity transitions. In tracking control, an improved Linear Quadratic Regulator (LQR) controller was designed using an Ackermann steering kinematic model. A curvature-adaptive weight matrix adjustment was dynamically optimized the controller's parameters, according to the real-time path curvature. Additionally, a target steering angle preview feedforward was implemented to reduce the overshoot for the tracking precision during curves. Simulation and real-world experiments demonstrated the effectiveness of the improved model. In the simulation ablation, the preview LQR was reduced the mean and maximum lateral errors by 30.0% and 33.6%, respectively, compared with the conventional LQR, indicating the independent contribution of the preview mechanism to the suppression of the curve overshoot. In the overall performance, the improved LQR was reduced the mean lateral error by 50.0%, 28.6%, 21.1%, and 40.0%, and the maximum lateral error by 49.6%, 24.1%, 4.3%, and 59.8%, respectively, compared with the conventional LQR, preview LQR, pure pursuit, and Stanley. In heading error, the improved LQR was achieved in the mean and maximum of 0.005 and 0.064 rad, respectively, the mean heading error was reduced by 28.6%, 16.7%, 16.7%, and 64.3%, and the maximum heading error by 31.9%, 28.1%, 29.7%, and 77.6%, respectively, compared with the four benchmarks. The velocity errors were also minimized at 0.014 m/s (mean) and 0.036 m/s (maximum). Real-vehicle tests on the uneven grassland were further validated the robustness. Quantitative analysis of the ablation group showed that the preview LQR was reduced the mean and maximum lateral errors by 26.1% and 23.3%, and the mean and maximum heading error by 13.3% and 3.9%, respectively, compared with the conventional LQR. The mechanism was effectively validated to enhance the heading stability. Furthermore, the improved LQR was reduced the mean lateral error by 48.9%, 30.9%, 13.0%, and 56.5%, and the maximum lateral error by 43.9%, 26.9%, 22.8%, and 72.7%, respectively, compared with the conventional LQR, preview LQR, pure pursuit, and Stanley. The mean heading error reached 0.018 rad, which was reduced by 40.0%, 30.8%, 18.2%, and 71.0%, respectively, compared with the four benchmarks. Although the maximum heading error showed a 15.5% increase, compared with the pure pursuit, whereas, it decreased by 9.4%, 5.7% and 49.8%, respectively, compared with the conventional LQR, preview LQR, and Stanley. In velocity tracking, the improved LQR exhibited the smallest fluctuations, indicating the superior stability under challenging field conditions. The path-velocity-control cooperative optimization was integrated to significantly enhance the tracking accuracy, operational smoothness, and field adaptability of the unmanned agricultural machinery. Synergistic planning and adaptive control were effectively realized to overcome the limitations of the conventional method. Therefore, this finding can provide a solid technical foundation to deploy the intelligent agricultural equipment in the irregular terrains. Future research can also explore the reinforcement learning for the parameter tuning, in order to further improve the system adaptability and deployment efficiency.

     

/

返回文章
返回