基于GNSS/MIMU/DR的农业机械组合导航定位方法

摘要

为解决实际农田环境中农业机械自动导航系统的位姿信息易受跟踪卫星数动态变化、天线遮挡、数据传输错误等因素影响,造成定位精度和稳定性变差的问题,采用全球导航卫星系统(GNSS)、微机械惯性测量单元(MIMU)及航位推算(DR)相融合的组合导航定位系统,建立了农业机械两轮运动学定位模型,针对系统状态噪声不稳定的因素,提出了一种根据当前估计值与预测值的偏差自适应地调节系统状态协方差阵的扩展卡尔曼滤波算法,并分别基于静止状态和直线导轨运动状态进行了试验验证。试验结果表明,在静止状态和直线导轨运动状态下,采用自适应滤波算法的航向角平均值绝对偏差分别为0.001 4°、0.024 5°,标准差分别为0.047 4°、0.251 1°;位置距离平均偏差分别为0.003 7 m、0.007 6 m,标准差分别为0.001 0 m、0.004 4 m,与固定值滤波算法相比,自适应滤波算法的各项评价指标得到了明显改善,进一步验证了算法改进的必要性和优越性。