基于自校准变结构Kalman的农机导航BDS失锁续航方法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

国家重点研发计划项目(2017YFD0700404)和广东省重点领域研发计划项目(2019B020224001)


Self-calibrating Variable Structure Kalman Filter for Tractor Navigation during BDS Outages
Author:
Affiliation:

Fund Project:

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

    针对农机自动导航作业过程中存在的BDS信号失锁导致系统突然失控的问题,提出了一种适用于轮式农机的基于自校准变结构Kalman滤波器的农机导航BDS失锁续航方法。依据4自由度农机运动学模型,设计了BDS/INS信息融合Kalman滤波器;进行INS导航定位误差不确定度分析,并设计了基于自回归模型的航向校准方法、INS传感器角速率测量零偏实时校准方法,结合上述方法设计了自校准变结构滤波器,进行位姿信息处理,结合导航跟踪控制方法实现失锁续航功能。根据分米级精度要求,进行了机器人直线、矩形路径失锁续航试验和农机田间直线续航试验。机器人续航试验结果表明:行驶速度为1m/s时,与运用未校准滤波器的续航系统相比,该方法实际平均横向偏差减小34%,横向偏差达到20cm时机器人在路径上的平均行驶距离提高80%。农机田间续航试验结果表明:行驶速度为1m/s时,在实际偏差小于20cm的条件下,农机在路径上的行驶平均距离达到16.65m。

    Abstract:

    BDS outages and leads to steering failure is an acknowledged challenge when the agricultural machine is automatically navigating. Steering failure will lead to increased labor intensity and loss of agricultural materials. A kind of self-calibrating variable structure Kalman filter for tractor navigation during BDS outages was presented. A Kalman filter was designed to integrate BDS and INS information for improving positioning quality. The filter was real-time calibrated by a calibration method of initial heading based on auto regressive model and a calibration method of angular rate zero offset online, which could process BDS/INS information and combined navigation tracking control method, thus implementing the continuous navigation function. The method was tested for decimeter accuracy in both robotic vehicle navigation system and tractor in-field to follow paths with lines and rectangles during BDS outages. In the robotic vehicle test, the speed of vehicle was set 1.0m/s, the performance was compared with that of the variable structure Kalman method without self-calibrating. The results showed that the self-calibrating variable structure Kalman method reduced the actual lateral deviation and BDS between INS positioning distance during BDS outages by 34% and 44%, respectively. The average driving distance was increased by 80% when the lateral deviation reached 20cm, and then reduced. In the tractor in-field test, the speed of vehicle was set 1.0m/s, the average driving distance reached 16.65m when the lateral deviation reached 20cm. This method had guiding value for the emergency endurance processing of BDS outages in the process of cotton planting automatic navigation.

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

张闻宇,王进,张智刚,何杰,胡炼,罗锡文.基于自校准变结构Kalman的农机导航BDS失锁续航方法[J].农业机械学报,2020,51(3):18-27. ZHANG Wenyu, WANG Jin, ZHANG Zhigang, HE Jie, HU Lian, LUO Xiwen. Self-calibrating Variable Structure Kalman Filter for Tractor Navigation during BDS Outages[J]. Transactions of the Chinese Society for Agricultural Machinery,2020,51(3):18-27.

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2019-11-16
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2020-03-10
  • 出版日期: