无人农机组合导航系统自适应零速修正技术研究
CSTR:
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

云南省重点研发计划项目(202103AN080001)和云南省烟草公司曲靖市公司科技计划项目(2024YNQJKJ07)


Adaptive Zero-velocity Update Technology for Integrated Navigation System of Unmanned Agricultural Machinery
Author:
Affiliation:

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    针对农机停车期间定位导航系统精度低的问题,本文提出一种包含速度约束与航向角约束的自适应零速修正算法,并在自主研发的小型农机上搭建单天线BDS/INS组合导航系统验证所提方法可行性与优势。为确保在进行零速修正时农机处于停车状态,通过实测数据分析,设计基于x轴(右方)加速度和z轴(上方)角速度方差的零速检测器,并根据零速持续时间窗口长度剔除大量离散分布但持续时间较短的误检零速区间。由于单天线组合系统在静止时无法提供有效的航向角估计值,则将进入停车时刻的航向角作为对应停车阶段零速修正航向角量测方程输入值;且为降低异常BDS定位量测值对系统的影响,引入Sage-Husa自适应滤波对其定位噪声实时估计。通过田间车载试验表明,本文零速检测方法准确率较高,符合农机实际行驶状态;在BDS可用期间,自适应零速修正可将航向角、速度与定位的精度分别提升99.3%、93.3%与50%,而在受干扰期间,定位精度提升大于90%;在BDS中断60s期间,纯INS导航误差快速增大导致失效,而零速修正可长时间维持INS高精度,并满足丘陵山区无人农机作业精度要求。本文方法可提高单天线BDS/INS组合导航系统在复杂工况下作业的精度以及抗干扰性,也可为其他无人农机研究提供参考。

    Abstract:

    Aiming at the problem of low accuracy of positioning and navigation system during the parking of agricultural machinery, an adaptive zero velocity update algorithm containing velocity constraints and heading angle constraints was proposed, and a single-antenna BDS/INS integrated system on a self-developed small agricultural machinery was built to verify the feasibility and advantages of the proposed method. In order to ensure that the agricultural machinery remained in a stationary state during zero velocity update, a zero-velocity detector based on the acceleration of x axis (right side) and the angular velocity variance of z axis (top side) was designed through the analysis of the measured data, and a large number of misdetected zero-velocity intervals that were discretely distributed but with short durations were eliminated based on the length of the zero-velocity duration window. Due to the inability of a single antenna combination system to provide a valid estimated value of heading angle at rest, the heading angle at the moment of parking would be used as the input value for the zero-velocity update heading angle measurement equation during the corresponding parking phase. And in order to reduce the influence of the abnormal BDS positioning observations on the integrated system, Sage-Husa adaptive filtering was introduced to estimate its positioning noise in real time. The field experiments showed that the zero-velocity detection method had a high accuracy rate, which was in line with the actual driving state of agricultural machinery. During periods of BDS availability, adaptive zero velocity update improved the accuracy of heading angle, velocity, and positioning by approximately 99.3%, 93.3%, and 50%, respectively. When BDS signals were disturbed, the positioning accuracy improvement can exceed 90%. During a 60-second BDS outage, pure INS navigation errors grew rapidly and led to failure, whereas zero velocity update maintained high INS accuracy for an extended period, meeting the precision requirements for unmanned agricultural machinery operations in hilly and mountainous areas. The research result demonstrated that the method can improve the accuracy and anti-interference of single antenna BDS/INS integrated navigation system under complex working conditions, and it was also helpful to provide references for other unmanned agricultural machinery research.

    参考文献
    相似文献
    引证文献
引用本文

刘剑雄,梁永欣,金浩,晏飞,张涛,李玲美.无人农机组合导航系统自适应零速修正技术研究[J].农业机械学报,2026,57(6):24-35. LIU Jianxiong, LIANG Yongxin, JIN Hao, YAN Fei, ZHANG Tao, LI Lingmei. Adaptive Zero-velocity Update Technology for Integrated Navigation System of Unmanned Agricultural Machinery[J]. Transactions of the Chinese Society for Agricultural Machinery,2026,57(6):24-35.

复制
分享
相关视频

文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2025-04-09
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2026-04-15
  • 出版日期:
文章二维码