高级检索+

丘陵山区小型农机单天线BDS/INS/OD组合定位系统

Single-antenna BDS/INS/OD integrated positioning system for small-scale agricultural machinery in hilly and mountainous areas

  • 摘要: 为提高丘陵山区小微型无人农机定位系统在复杂环境与工况下的作业精度,该研究提出一种可变结构的单天线北斗导航卫星系统(BeiDou Navigation Satellite System,BDS)/惯性导航系统(Inertial Navigation System,INS)/里程计(Odometer,OD)组合定位系统。在BDS可用期间,在基于Sage-Husa自适应滤波的BDS/INS/OD系统中加入非完整性约束(Non-Holonomic Constrain,NHC)构造完整速度约束,以抑制因农机剧烈振动而导致发散的速度误差,并提高定位测量噪声的估计效率与精度;在BDS中断期间,取消定位信息输入并切换为INS/OD系统,采用强跟踪滤波降低异常速度观测信息的影响,实现高精度导航。根据2种组合模式定位噪声特征的差异,分别设计一阶与三阶的S-G低通滤波器对导航路径点进行平滑处理,以改善在农机低速工况下以历史定位信息估计航向角的精度。以自主研发的小型农机为平台搭建组合定位系统进行田间车载试验,结果表明:在BDS稳定工作期间,BDS/INS/OD系统水平定位误差均值、均方根与最大值分别为0.007、0.007与0.063 m;在3次持续时间为60 s的BDS定位误差增大期间,BDS/INS/OD系统误差均值、均方根与最大值分别为0.075、0.039与0.166 m;在3次持续时间为60 s的BDS中断期间,INS/OD系统误差均值、均方根与最大值分别为0.051、0.022与0.128 m;且速度与姿态角误差均无发散趋势。该研究表明,基于自适应滤波与运动约束原理的单天线BDS/INS/OD组合定位系统在复杂工况下的稳定性较高,满足丘陵山区无人农机的作业精度要求,具备较强的自适应与抗干扰性能。

     

    Abstract: With the acceleration of agricultural modernization, the demand for intelligent and precise agricultural production has been continuously increasing. In the hilly and mountainous areas of China, due to geographical constraints and diverse planting patterns, small and micro agricultural machinery are more suitable for field operations. However, the research and development of small and micro unmanned agricultural machinery dedicated to hilly and mountainous areas started relatively late with a weak foundation. Furthermore, constrained by the limited body size of such machinery, the well-established high-precision positioning equipment designed for medium and large unmanned agricultural machinery can hardly be adapted to them. Therefore, in order to improve the operation accuracy of the navigation system for small and micro unmanned agricultural machinery in hilly and mountainous areas under complex environments and working conditions, this study proposed a variable-structure single-antenna BDS/INS/OD integrated positioning system. During the availability of BDS, the non-holonomic constraint (NHC) was incorporated into the Sage-Husa adaptive filter-based BDS/INS/OD system to construct a complete velocity constraint. This not only suppressed the velocity error that tended to diverge due to the severe vibration of agricultural machinery, but also enhanced the efficiency and accuracy of position measurement noise estimation. During BDS outages, the position measurement was disabled and the system was switched to the INS/OD system. The strong tracking filter was adopted to reduce the impact of abnormal velocity observation information, achieving high-precision seamless navigation. In addition, based on the differences in positioning noise characteristics between the two navigation modes, first-order and third-order Savitzky-Golay (S-G) low-pass filters based on a sliding window were designed respectively to smooth the navigation waypoints, which improved the accuracy of heading angle estimation using historical positioning information when the agricultural machinery operated at low speeds. The sliding window length of the smoothing filter was correlated with the traveling speed of the agricultural machinery: a short distance caused the heading angle estimation to be overly sensitive and resulted in large fluctuations, while an excessively long distance made the estimation more susceptible to historical paths and reduced real-time performance. In this paper, the distance between the latest positioning point and the farthest positioning point was set within the range of 1.5–2.0 m. Meanwhile, to avoid overshoot of the adaptive filter, the boundaries of the noise variance matrix and the posteriori estimation covariance were constrained. An integrated system was built using a self-developed small agricultural machinery as the platform, and vehicle-mounted field experiments were conducted. The experimental site was selected as an open area with low susceptibility to interference, and the traveling speed of the agricultural machinery was approximately 0.38 m/s. The results showed that: during the normal and stable operation of BDS, the mean, root mean square (RMS), and maximum value of the horizontal distance error of the standalone BDS were 0.018 m, 0.01 m, and 0.045 m, respectively; the mean, RMS, and maximum value of the horizontal distance error of the BDS/INS/OD system were 0.007 m, 0.007 m, and 0.063 m, respectively, and the maximum error occurred during the severe oscillation caused by emergency braking. During three 60-second BDS outages periods, the mean, RMS, and maximum value of the error of the INS/OD system were 0.051 m, 0.022 m, and 0.128 m, respectively. To simulate the BDS interference condition, preset random errors following a zero-mean normal distribution with an RMS of 1 m were artificially injected into the BDS positioning results along the north, east and up directions during three 60-second periods. When the BDS positioning error increased under simulated interference, the mean, RMS, and maximum value of the error of the BDS/INS/OD system were approximately 0.075 m, 0.039 m, and 0.166 m, respectively; additionally, there was no divergence trend in the velocity and attitude angle errors, and the latter could be used to compensate for positioning deviations caused by the inclination of the agricultural machinery. This study demonstrates that the single-antenna BDS/INS/OD integrated navigation system, which organically combines adaptive filtering and motion constraint principles, exhibits high stability under complex working conditions. It not only meets the operation accuracy requirements of unmanned agricultural machinery in hilly and mountainous areas, but also possesses strong adaptability and anti-interference performance. The findings also provide an important reference for the research and development of positioning systems for other outdoor vehicles operating under complex working conditions and environments.

     

/

返回文章
返回