基于星基增强精密单点定位的农机自动导航系统开发与测试

    张智刚, 王明昌, 毛振强, 王辉, 丁凡, 李洪开, 张天

    张智刚, 王明昌, 毛振强, 等. 基于星基增强精密单点定位的农机自动导航系统开发与测试[J]. 华南农业大学学报, 2021, 42(6): 109-116. DOI: 10.7671/j.issn.1001-411X.202107016
    引用本文: 张智刚, 王明昌, 毛振强, 等. 基于星基增强精密单点定位的农机自动导航系统开发与测试[J]. 华南农业大学学报, 2021, 42(6): 109-116. DOI: 10.7671/j.issn.1001-411X.202107016
    ZHANG Zhigang, WANG Mingchang, MAO Zhenqiang, et al. Development and test of auto-navigation system for agricultural machinery based on satellite-based precision single-point positioning[J]. Journal of South China Agricultural University, 2021, 42(6): 109-116. DOI: 10.7671/j.issn.1001-411X.202107016
    Citation: ZHANG Zhigang, WANG Mingchang, MAO Zhenqiang, et al. Development and test of auto-navigation system for agricultural machinery based on satellite-based precision single-point positioning[J]. Journal of South China Agricultural University, 2021, 42(6): 109-116. DOI: 10.7671/j.issn.1001-411X.202107016

    基于星基增强精密单点定位的农机自动导航系统开发与测试

    基金项目: 国家自然科学基金(32071914);农业农村部星基辅助自动驾驶系统产业化评估试验与推进项目
    详细信息
      作者简介:

      张智刚(1977—),男,副教授,博士,E-mail: zzg208@scau.edu.cn

    • 中图分类号: TP23;S24

    Development and test of auto-navigation system for agricultural machinery based on satellite-based precision single-point positioning

    • 摘要:
      目的 

      开发基于星基增强精密单点定位的农机自动导航系统。

      方法 

      以国产雷沃TX1204拖拉机为平台,采用国产星基增强定位板卡的输出数据作为农机位置反馈量,设计位速卡尔曼滤波器对定位数据进行滤波处理,开发预瞄跟随PID路径跟踪控制算法进行导航控制,整定不同行驶速度条件下的模型控制参数,采用地基增强RTK高精度定位接收机输出数据作为参考量,搭建农机自动导航测试系统并开展系统性能测试。

      结果 

      在直线跟踪误差方面,所开发的农机自动导航系统平均误差为−0.0009436 m,标准差为0.02452 m,最大误差绝对值为0.08472 m;在邻接行误差方面,平均误差为0.0007128 m,标准差为0.02986 m,最大误差绝对值为0.15444 m。这一精度可满足大部分农机自动导航作业需求。

      结论 

      将国产星基增强精密单点定位技术用于农机自动导航是可行的;本文设计的预瞄跟随PID路径跟踪控制模型和提出的不同速度条件下PID参数与前视距离的整定方法,提高了系统对不同速度的自适应能力。

      Abstract:
      Objective 

      To develop an automatic navigation system for agricultural machinery based on satellite-based precision single-point precision.

      Method 

      With the domestic Lovol TX1204 tractor as the platform, the output data of the domestic satellite-based precision single-point positioning board were used as the position feedback of the agricultural machinery, the position-velocity Kalman filter was designed to filter the positioning data, and the preview following PID path tracking control algorithm was developed. The model control parameters under different driving speed conditions were tuned, and the output data of the ground-based RTK high-precision positioning receiver were used as the references, the automatic navigation test system of agricultural machinery was built and the system performance test was carried out.

      Result 

      In terms of linear tracking error, the average error was −0.0009436 m, the standard deviation was 0.02452 m, and the absolute maximum error was 0.08472 m. In terms of adjacent line error, the average error was 0.0007128 m, the standard deviation was 0.02986 m, and the absolute maximum error was 0.15444 m, which could meet the needs of most agricultural machinery automatic driving operations.

      Conclusion 

      Domestic satellite-based precision single-point positioning technology can be used for agricultural machinery automatic navigation. The preview-following PID path tracking control model designed in this paper is valid and the proposed method for tuning PID parameters and foresight distance under different speed conditions provides a basis for improving the adaptive ability of this system to different speed conditions.

    • 图  1   农机自动导航系统的总体结构示意图

      Figure  1.   Schematic diagram of the overall structure of the agricultural machinery automatic navigation system

      图  2   预瞄追踪模型几何示意图

      Figure  2.   Geometric diagram of preview tracking model

      图  3   拖拉机自动导航测试系统结构

      Figure  3.   Test system structure for satellite-based automatic pilot system of tractor

      图  4   系统误差测试行驶方式示意图

      Figure  4.   Schematic diagram of driving mode of system error test

      图  5   不同速度下自动驾驶系统路径跟踪误差曲线

      Figure  5.   Path tracking error curve of automatic autopilot system at different speed

      表  1   不同速度条件下的路径跟踪控制参数

      Table  1   Navigation control parameters under different travelling speeds

      速度/
      (km·h−1)
      Velocity
      前视距离/m
      Foresight
      distance
      比例
      Proportional
      (P)
      积分
      Integral
      (I)
      微分
      Differential
      (D)
      3 1.4 170 13 39
      5 2.4 150 10 30
      7 3.2 130 8 22
      下载: 导出CSV

      表  2   农机星基辅助自动导航系统性能统计表

      Table  2   Performance statistics of satellite-based auxiliary agricultural machinery automatic autopilot system

      行驶速度/
      (km·h−1)
      Driving speed
      直线跟踪误差/m Straight line tracking error 邻接行误差/m Adjacent row error
      平均误差
      Average
      error
      标准差
      Standard
      deviation
      最大误差绝对值
      Absolute value of
      maximum error
      平均误差
      Average
      error
      标准差
      Standard
      deviation
      最大误差绝对值
      Absolute value of
      maximum error
      3 −0.0007564 0.01430 0.08867 0.0006187 0.01513 0.11736
      5 −0.0009170 0.02374 0.07096 0.0007249 0.02486 0.12254
      7 −0.0011575 0.03553 0.09455 0.0007950 0.04960 0.22342
      平均值 Average −0.0009436 0.02452 0.08472 0.0007128 0.02986 0.15444
      下载: 导出CSV
    • [1] 夏普. 农机自动导航系统精度影响因素分析与试验研究[D]. 泰安: 山东农业大学, 2018.
      [2] 晓琳, 薄斌, 知谷APP. 合众思壮: 推进精准农业全球化发展[J]. 农业机械, 2019(7): 29-31.
      [3] 韩树丰, 何勇, 方慧. 农机自动导航及无人驾驶车辆的发展综述(英文)[J]. 浙江大学学报(农业与生命科学版), 2018, 44(4): 381-391.
      [4] 化祖旭. 自动驾驶汽车路径跟踪控制算法综述[J]. 装备制造技术, 2021(6): 100-103.
      [5] 张超. BDS/GPS精密单点定位模型与质量控制研究[D]. 淄博: 山东科技大学, 2014.
      [6] 张胜利. 基于三频模糊度解算的精密单点定位技术研究与实现[D]. 西安: 西安电子科技大学, 2017.
      [7] 鲍建宽, 陈伟荣, 高成发. 精密单点定位的数学模型选择[J]. 黑龙江工程学院学报(自然科学版), 2013, 27(2): 1-4.
      [8] 吴紫晗. 北斗导航系统在农机化应用现状浅析[J]. 农机科技推广, 2020(7): 32-34. doi: 10.3969/j.issn.1671-3036.2020.07.016
      [9] 朱清山, 高广智, 牛文祥. 农机自动导航驾驶系统及其应用[J]. 现代化农业, 2016(5): 65-67. doi: 10.3969/j.issn.1001-0254.2016.05.037
      [10]

      ZENG P. Research on precise point positioning based on RTKLIB[J]. International Journal of Intelligent Information and Management Science, 2020, 9(6): 275-277.

      [11]

      NIE Z X, WANG B Y, WANG Z J, et al. An offshore real-time precise point positioning technique based on a single set of BeiDou short-message communication devices[J]. Journal of Geodesy:Continuation of Bulletin Géodésique and manuscripta geodaetica, 2020, 94(9): 78.

      [12] 陈玉龙. 浅析GPS精密单点定位技术及应用[J]. 科技创新与生产力, 2017(9): 72-73. doi: 10.3969/j.issn.1674-9146.2017.09.072
      [13] 张之琛. GPS/BDS实时精密单点定位技术实现[J]. 现代导航, 2020, 11(3): 171-177. doi: 10.3969/j.issn.1674-7976.2020.03.004
      [14] 孟范伟. GPS卫星钟差预报与精密钟差估计研究[D]. 青岛: 山东科技大学, 2014.
      [15]

      INNAC A, ANGRISANO A, GAGLIONE S, et al. Performance comparison among multi-GNSS single frequency precise point positioning techniques[J]. Cartography and Geoinformation, 2019, 18(32): 80-99.

      [16] 范先铮, 帅明明. GPS精密单点定位技术要点及其处理方法研究[J]. 测绘通报, 2020(S1): 305-310.
      [17] 刘建强. 基于stm32的农机自动驾驶系统的设计与实现[D]. 廊坊: 北华航天工业学院, 2019.
      [18] 刘兆朋, 张智刚, 罗锡文, 等. 雷沃ZP9500高地隙喷雾机的GNSS自动导航作业系统设计[J]. 农业工程学报, 2018, 34(1): 15-21. doi: 10.11975/j.issn.1002-6819.2018.01.03
      [19] 尤文宽. 拖拉机播种作业自动转向控制系统的设计与研究[D]. 石河子: 石河子大学, 2014.
      [20] 吴林, 施闯, 姜斌. 基于北斗/GNSS星基PPP增强技术的农机自动导航驾驶系统[J]. 农机科技推广, 2019(10): 41-43. doi: 10.3969/j.issn.1671-3036.2019.10.020
      [21] 史扬杰, 奚小波, 吴飞, 等. 电机式北斗农机自动导航系统设计与试验[J]. 东北农业大学学报, 2019, 50(4): 88-96. doi: 10.3969/j.issn.1005-9369.2019.04.011
      [22] 张智刚, 罗锡文, 胡炼, 等. 4种DGPS模块动态定位精度测试与分析[J]. 华南农业大学学报, 2010, 31(1): 102-107. doi: 10.3969/j.issn.1001-411X.2010.01.025
      [23] 王辉, 王桂民, 罗锡文, 等. 基于预瞄追踪模型的农机导航路径跟踪控制方法[J]. 农业工程学报, 2019, 35(4): 11-19. doi: 10.11975/j.issn.1002-6819.2019.04.002
      [24] 万豪, 莫中秋, 张宇. 农业机械自动驾驶系统轨迹跟踪误差测试[J]. 无线电工程, 2020, 50(5): 373-376. doi: 10.3969/j.issn.1003-3106.2020.05.007
      [25] 刘辉. 农机自动导航系统作业精度评价方法研究与试验验证[D]. 泰安: 山东农业大学, 2017.
      [26] 张智刚, 朱启明, 何杰, 等. 基于RTK-GNSS和MEMS陀螺仪的车辆航向角测量技术[J]. 华南农业大学学报, 2019, 40(5): 34-37. doi: 10.7671/j.issn.1001-411X.201905085
      [27] 张闻宇, 王进, 张智刚, 等. 基于自校准变结构Kalman的农机导航BDS失锁续航方法[J]. 农业机械学报, 2020, 51(3): 18-27. doi: 10.6041/j.issn.1000-1298.2020.03.002
    图(5)  /  表(2)
    计量
    • 文章访问数:  1378
    • HTML全文浏览量:  6
    • PDF下载量:  789
    • 被引次数: 0
    出版历程
    • 收稿日期:  2021-07-08
    • 网络出版日期:  2023-05-17
    • 刊出日期:  2021-11-09

    目录

      /

      返回文章
      返回