基于UWB-IMU的设施园艺移动平台组合定位方法

    Combined UWB and IMU based mobile platform localization method for protected horticulture

    • 摘要: 为解决设施场景下遮挡严重所致的电驱移动平台定位精度低、稳定性差的问题,该研究设计了基于超宽带(ultra wide band,UWB)和惯性测量单元(inertial measurement unit,IMU)的组合定位方法,并提出基于卡尔曼滤波的自适应抗差组合定位算法(adaptive robust combination positioning algorithm,ARCPA)。首先,针对单传感器定位误差大的问题,搭建基于UWB与IMU两种传感器的组合定位系统;其次,为精准检测UWB数据的非视距误差,设计差分距离非视距误差检测滑动窗口;最后,为抑制卡尔曼滤波中的量测噪声,采用余弦重启函数实时调整渐消因子,并引入位置精度因子权值修正抗差因子。为验证所提定位方法的有效性,搭建设施园艺电驱移动平台和实时定位系统,并进行仿真与实车定位试验。试验结果表明,采用所提UWB-IMU组合定位方法的均方根误差为6.63 cm,比单传感器的定位精度提高了81.92%,相比于经典卡尔曼滤波、无迹卡尔曼滤波、扩展卡尔曼滤波、粒子滤波与自适应抗差卡尔曼滤波算法,所提ARCPA算法定位精度分别提高50.15%、74.63%、60.01%、60.88%、28.34%。研究结果可为设施园艺环境下的定位导航提供理论依据和实施方案。

       

      Abstract: To address the problem of low positioning accuracy and poor stability of electric drive mobile platforms caused by object obstruction in protected horticulture scenes, this study designs a combined positioning method based on ultra-wide band (UWB) and inertial measurement unit (IMU). Additionally, an adaptive robust combination positioning algorithm (ARCPA) based on Kalman filtering is developed to effectively improve positioning accuracy and enhance stability. Firstly, a multi-sensor integrated positioning system combining UWB and IMU is constructed. Secondly, a differential distance-based sliding window method is introduced to precisely detect non line of sight (NLOS) errors in the positioning data of UWB. Furthermore, to address the interference of measurement noise fluctuations in Kalman filtering, a cosine restart function is used to dynamically adjust the fading factor in real-time, thereby enhancing the accuracy and robustness of the filter. Finally, a position dilution of precision (PDOP) weighted robust factor is incorporated to improve the resilience of the positioning system against noise and model disturbances in protected horticulture scenes. In order to verify the effectiveness of proposed integrated positioning, an electric drive mobile platform and real-time positioning system are built, then the simulation and real vehicle positioning experiments are conducted in the typical protected horticulture scenes. The experimental results demonstrate that the root-mean-square errors before and after UWB ranging correction under line-of-sight condition are 119.0 cm and 49.0 cm, respectively, and the ranging accuracy improved by 58.8% after correction. The positioning error of single sensor reaches 36.68 cm, while the error of the proposed integrated positioning method is only 6.63 cm, which is 81.92% higher than the positioning accuracy of single sensor, and the maximum error is reduced by 88.89%. This indicates that the proposed integrated positioning method can significantly reduce the impact of NLOS and geometric error on the positioning accuracy of the electric drive mobile platform for protected horticulture. Moreover, the root-mean-square error and maximum positioning error of ARCPA are 17.70 cm and 44.44 cm, respectively. Compared with the Kalman filtering, unscented Kalman filtering, extended Kalman filtering, particle filtering and adaptive robust Kalman filtering algorithms, the accuracy of the proposed method has been improved by 50.15%, 74.63%, 60.01%, 60.88% and 28.34%, respectively, and the maximum positioning error has been reduced by 66.83%, 73.67%, 69.07%, 71.2% and 50.50%, respectively. The finding can provide theoretical basis and implementation plan for positioning and navigation in protected horticulture environment.

       

    /

    返回文章
    返回