基于GNSS的农机自动导航路径搜索及转向控制

    Automatic navigation path search and turning control of agricultural machinery based on GNSS

    • 摘要: 为提高农机自动导航系统性能,提出了一种基于全球导航卫星系统(global navigation satellite system,GNSS)的农机自动导航路径搜索方法和基于预瞄点搜索的纯追踪模型。根据农机不同作业需求,导航系统可选择直线路径搜索或曲线路径搜索,实现农机直线和曲线自动导航作业;建立基于预瞄点搜索的纯追踪模型,并将其用于农机转向控制,该模型不涉及复杂的控制理论,适用性较强。为验证路径搜索方法和纯追踪模型性能,以John Deere拖拉机为试验平台,进行了农机直线跟踪和转向控制导航试验。结果表明:直线路径跟踪导航试验,车速为0.8、1.0和1.2 m/s时,导航均方根误差分别为3.79、4.28和5.39 cm;转向导航试验,车速为0.6 m/s时,在弓形转弯和梨形转弯导航方式下,导航均方根误差分别为25.23和14.42 cm;与模糊控制方法对比试验,直线路径导航方式下,应用该文方法和模糊控制方法的导航均方根误差分别为4.30和5.95 cm,在曲线路径导航方式下,应用该文方法和模糊控制方法的导航均方根误差分别为13.73和21.40 cm;基于GNSS的农机自动导航路径搜索方法和预瞄点搜索的纯追踪模型可以得到较好的定位控制精度,可满足田间实际作业的要求。

       

      Abstract: Abstract: In order to improve the performance of the agricultural machinery automatic navigation system, an automatic navigation path searching method of agricultural machinery based on GNSS (global navigation satellite system) was proposed. According to different demands of farm working, the system could generate the straight line or curve path for agricultural machinery automatic navigation according to users setting. In order to get the straight navigation path, the user should drive the tractor and record the current position marked as point A, and then choose the position marked as Point B at least 10 m far away from Point A. The straight line presupposed navigation path could be obtained by connecting Point A and B and extending the segment AB. The way of obtaining the curve presupposed navigation path is similar to the straight path searching method; the curve fits with several segments, and every segment is analyzed with the straight path searching method. When the navigation task began, the system would compare the current position and heading information of the tractor with the presupposed path to get the lateral deviation and heading deviation. In addition, a pure pursuit mode based on preview points research was proposed for steering control. The method didn't involve the complicated control theory, so that it could adapt the navigation system better. In the aspect of turning control, arcuate turning and pyriform turning patterns were selected as the major research objects. The turning path could be generated by the navigation system according to the tractor working width and the minimum turning radius after the users chose the kind of turning pattern, and a series of points could be chosen according to the tractor speed and each point was evenly spaced. When the navigation task began, the searching radius and preview point should be set according to the speed of the tractor. There were several points on the default navigation path falling in the searching circle; the point with the largest ID (identification) number would be selected as the preview point, and then the path of the tractor arriving to the preview point and the control turning angle would be obtained. To verify the path search method and the model of pure tracking performance, a tractor automatic navigation software was designed and implemented. The industrial computer as the carrier of navigation software, processed the GNSS data, IMU (inertial measurement unit) data and PLC (programmable logic controller) data, and then generated the corresponding decisions. A John Deere tractor was used as the platform for experiments, and the straight line / curve navigation experiments based on GNSS positioning technology were designed. The results of experiments were as follows: In the straight line navigation experiments, when the speed of the tractor was 0.8, 1.0 and 1.2 m/s, the root-mean-square error was 3.79, 4.28 and 5.39 cm respectively; in the turning navigation experiments, when the speed of the tractor was 0.6 m/s, the root-mean-square error of the arcuate turning navigation was 25.23 cm and the root-mean-square error of the pyriform turning navigation was 14.42 cm; for the comparison experiment, the root-mean-square error using the proposed method and fuzzy control method was 4.30 and 5.95 cm respectively in straight line navigation module, and 13.73 and 21.40 cm respectively in curve navigation module. The path searching method and the pure pursuit mode based on the researching of preview points can satisfy the requirement of the farmland works effectively.

       

    /

    返回文章
    返回