食用菌工厂空间约束下的机器人导航系统设计

    Design of a robot navigation system under spatial constraints in edible fungus factory

    • 摘要: 传统机器人导航方案在食用菌工厂内无法应对道路狭窄、卫星信号差,菇架排列导致空间特征点分布稀疏及单一传感器存在感知盲区等情况,为此该研究设计了食用菌工厂空间约束条件下多传感器融合的机器人导航系统。首先采用误差状态卡尔曼滤波器融合编码器和惯性测量单元(inertial measurement unit, IMU)数据提高定位准确性;然后提出了双激光雷达数据融合算法,并基于改进的cartographer激光建图算法构建导航栅格地图;最后基于Navigation2框架,使用自适应蒙特卡洛全局定位算法、Theta*全局路径规划算法和一种基于动态窗口的局部路径规划算法建立导航系统。试验结果表明,使用双激光雷达融合算法构建的栅格地图中障碍物检出率相比于单个激光雷达提升了2.07个百分点;机器人在0.40 m/s的移动速度下,定位的纵向偏差平均值、横向偏差平均值、角度偏差平均值分别小于5.80 cm、3.50 cm和3.00°,标准差分别小于1.47 cm、1.17 cm和1.16°。当机器人以0.20~0.70 m/s的速度移动时,导航的纵向偏差、横向偏差、航向偏差平均值分别小于5.78 cm、3.80 cm、4.00°,标准差分别小于1.63 cm、1.32 cm、0.84°。该方案的定位精度和导航精度均满足机器人在食用菌工厂作业时的导航要求,为食用菌产业的智慧化发展提供了重要的技术支撑。

       

      Abstract: Robot navigation is limited in the edible fungus factories, such as the narrow roads, GPS signal reception, sparse spatial distribution of feature points caused by shelf arrangements, as well as the perception blind spots from single sensors. However, the single-line LiDAR sensor cannot scan the entire mushroom rack, leading to incomplete navigation maps. It is often required for high navigation accuracy due to the absence of obstacles among the mushroom logs on the racks. In this study, a multi-sensor fusion was proposed for the robot navigation under spatial constraints in the edible fungus factories. Firstly, the error-state Kalman filter (ESKF) was used to fuse both encoders and IMUs sources, in order to improve the accuracy of the positioning. The noise and uncertainty were then reduced in the data collection from the encoders or inertial measurement units (IMUs). Then, a dual LiDAR data fusion was proposed to combine environmental information from different heights. Secondly, an improved Cartographer-based laser SLAM was used to construct a navigation grid map. The autonomous navigation framework was realized using Navigation2. The navigation of the robots was then utilized for the continuous switching among the planning, control, and recovery servers by calling the navigation tree server. Finally, the speed command was output to the microcontroller, which was controlled by the robot's movement. The Adaptive Monte Carlo Localization (AMCL) was used for the global positioning, while the Theta* algorithm was employed as the algorithm for the planning server. A dynamic algorithm of the window-based local path planning was applied to the control server in order to guide the movement of the robots. A comparison was performed on the constructed maps using the top and bottom LiDAR, as well as the fusion of both LiDARs. The top LiDAR failed to identify the gaps among the mushroom logs as obstacles, while the bottom LiDAR failed to scan the mushroom logs, only scanning part of the mushroom rack. The incomplete maps were constructed by a single LiDAR, while the dual LiDAR fusion was recognized as the mushroom logs that detected the mushroom racks. The results showed that there was an obstacle detection rate 2.07 percental points higher than that of a single LiDAR. In positioning accuracy tests, four target points were randomly selected along the longitudinal aisle. And then the positioning error was calculated to compare the robot's coordinates with the real coordinates of the target points. The encoder and IMU data were fused at a moving rate of 0.40 m/s in the robot. There were the maximum longitudinal, lateral, and angular deviations of 5.80 cm, 3.50 cm, and 3.00°, respectively, with the standard deviations of less than 1.47 cm, 1.17 cm, and 1.16°, respectively. The cumulative error of the encoder also increased gradually as the longitudinal displacement increased. In the navigation tests, the average longitudinal deviation, lateral deviation, and heading deviation between the actual and target navigation paths were 2.24 cm, 1.90 cm, and 2.04°, respectively, when the robot was navigated at 0.20 m/s. At a speed of 0.50 m/s, the average deviations were 4.10 cm, 2.64 cm, and 2.82°, respectively. At a speed of 0.70 m/s, the average deviations were 5.78 cm, 3.80 cm, and 4.00°, respectively. Overall, the robot's average longitudinal and lateral deviations were less than 5.78 cm and 3.80 cm, respectively, with the standard deviations of no more than 1.63 cm and 1.32 cm, respectively, and the average heading deviation was less than 4.00°, with a standard deviation of no more than 0.84°. Both positioning and navigation accuracies met the requirements for the robot operations. The finding can provide significant technical support to the intelligent development of the edible fungus industry.

       

    /

    返回文章
    返回