基于改进最小化SNAP的植保无人机作业轨迹优化算法

    Optimizing the flight path of plant protection UAV using improved minimum SNAP

    • 摘要: 轨迹优化是实现植保无人机自主作业路径规划的重要环节,合理高效的轨迹优化算法能使植保无人机安全快速地跟踪轨迹作业,提升作业稳定性与精准性。针对传统最小化SNAP算法偏移误差较大、时间分配不合理的问题,该研究提出一种针对植保作业场景的改进最小化SNAP轨迹优化算法。首先,运用机载载波相位差分(real-time kinematic, RTK)模块采集作业地块地形数据并搭建三维空间地图,基于空间地图采用牛耕法规划初始作业路径;其次,通过改进最小化SNAP算法优化作业路径,结合初始轨迹状态参量构建时间分配函数,解算得到当前最优时间分配;然后,重构最小化SNAP轨迹约束函数,添加位置偏移量梯度惩罚因子,采用最优化方法求解轨迹多项式系数;最后,联合无人机位置控制周期与轨迹多项式实例化航迹点,作为无人机运动的位置期望。试验结果表明,相较于传统最小化SNAP算法,本文算法在同等作业时间前提下,平均加速度减小7.82%,平均偏移误差减小45.56%,对轨迹偏移的抑制效果明显,并降低了加速度在地头转向处的超调,作业轨迹更加精准,作业速度更加平稳,可为植保无人机的轨迹优化策略提供参考。

       

      Abstract: Plant protection is moving toward mechanization and intelligence in the process of modern agriculture in recent years. Autonomous operation of unmanned aerial vehicles (UAV) can reduce the quality errors from the visual images or manual experience, particularly for labor cost saving. Among them, trajectory optimization is one of the most important steps during the autonomous operation of plant protection UAVs. A reasonable algorithm of trajectory optimization can be expected for the UAVs to more efficiently and safely realize the tracking operations. The current algorithm of mainstream optimization focuses mainly on trajectory accuracy and algorithm efficiency in the tracing scene. But there is an overshoot of state quantity and serious trajectory deviation in the special scene of agricultural plant protection, due to complex situations, such as line feed and turn. Therefore, it is very necessary to optimize the trajectory suitable for the operation scenarios of plant protection. Simple time allocation cannot fully meet the requirements of trajectory optimization in the traditional minimum-SNAP algorithm, such as the large trajectory deviation error. In this study, an improved minimum-SNAP algorithm was proposed for trajectory optimization in the operation scenarios of plant protection. Firstly, the real-time kinematic (RTK) integrated navigation system carried by the plant protection UAV was used to collect the topographic data of the plant protection plots. Then the data was imported into the robot operating system (ROS) in the central controller. The surface fitting was also utilized to obtain the three-dimensional spatial map. The cattle ploughing method was selected to plan the initial operation path. Secondly, the task path was optimized using an improved minimum-SNAP algorithm. The cost function of time allocation was also constructed using the state parameter variable of the initial operation path. In addition, the change rate of the initial path baseline angle was introduced as a reference factor, in order to obtain the optimal time allocation after optimization. Thirdly, the coefficient optimization cost function of the minimum-SNAP algorithm was reconstructed using the time allocation information. The gradient penalty factor of position offset was then added to the optimization function. The trajectory expression of the piecewise polynomial was then obtained to solve the coefficient of the trajectory polynomial after optimization. Finally, the UAV position control period was substituted into the piecewise trajectory polynomial for the track point, which was taken as the location expectation to control the UAV motion. A simulation test was carried out to preliminarily verify using the Matlab platform. The initial path was taken as the "U" type round-trip operation track in two-dimensional space. The average acceleration of the improved algorithm was 0.390 m/s2, which was 19.75% lower than the traditional. Furthermore, the average trajectory offset was 0.051 m/s2, which was 66.88% lower than the traditional. The physical test site was selected as the mulberry forest on the slope with the complex terrain. The test results show that the improved algorithm reduced the average acceleration and deviation by 7.82%, and 45.56%, respectively, compared with the traditional under the same running time. An outstanding inhibition was achieved in the trajectory deviation with the reduced overshoot during line feed turning. The finding can also provide a technical and theoretical basis for the UAV trajectory optimization in the scenario of plant protection.

       

    /

    返回文章
    返回