Integrated Positioning System of Kiwifruit Orchard Mobile Robot Based on UWB/LiDAR/ODOM

摘要

To address the issue of low positioning accuracy of mobile robots in trellis kiwifruit orchards with weak signal environments, this study investigated an outdoor integrated positioning method based on ultra-wideband (UWB), light detection and ranging (LiDAR), and odometry (ODOM). Firstly, a dynamic error correction strategy using the Kalman filter (KF) was proposed to enhance the dynamic positioning accuracy of UWB. Secondly, the particle filter algorithm (PF) was employed to fuse UWB/ODOM/LiDAR measurements, resulting in an extended Kalman filter (EKF) measurement value. Meanwhile, the odometry value served as the predicted value in the EKF. Finally, the predicted and measured values were fused through the EKF to estimate the robot's pose. Simulation results demonstrated that the UWB/ODOM/LiDAR integrated positioning method achieved a mean lateral error of 0.076 m and a root mean square error (RMSE) of 0.098 m. Field tests revealed that compared to standalone UWB positioning, UWB-based KF positioning, and LiDAR/ODOM integrated positioning methods, the proposed approach improved the positioning accuracy by 64.8%, 13.8%, and 38.3%, respectively. Therefore, the proposed integrated positioning method exhibits promising positioning performance in trellis kiwifruit orchards with potential applicability to other orchard environments.