Multi‑sensor fusion mapping and navigation research for tomato greenhouse robot

doi:10.13733/j.jcam.issn.2095-5553.2025.04.025

Abstract

Abstract: According to the corridor environment and vegetation distribution in tomato greenhouse, SLAM and navigation algorithm of robot multi‑sensor fusion are optimized. Firstly, based on the Cartographer algorithm, the dedistortion processing of LiDAR data was carried out, and then the unscented Kalman filter (UKF) was used to fuse the information of LiDAR, odometer and IMU to optimize the robot pose estimation, and the optimized algorithm was used to construct a high‑precision map of the greenhouse. The established high‑precision raster map is verified by the improved A* and DWA fusion algorithm, and the search efficiency and path safety of the A* algorithm are improved by dynamically adjusting the weights and optimizing the search logic, so that the robot can find the optimal and safe path more intelligently in the greenhouse environment, and the effectiveness of the algorithm is verified in the gazebo platform of ROS and the greenhouse environment in the field. The experimental results indicated that the average position deviation was 10.3 cm when the running speed of the robot was not more than 0.6 m/s, which met the operation requirements of the tomato greenhouse.

Key words: tomato, greenhouse robot, multi?sensor fusion, laser SLAM, path planning, navigation

摘要： 针对番茄温室中的长廊环境及植被分布问题，对番茄机器人的多传感器融合的SLAM和导航算法进行优化。基于Cartographer算法，进行激光雷达数据去畸变处理，再通过无迹卡尔曼滤波(UKF)融合激光雷达、里程计及IMU信息进行机器人位姿估计优化，并使用优化后的算法对温室进行高精度地图构建。将建立的高精度栅格地图使用改进的A*与DWA融合算法进行验证，通过动态调整权重和优化搜索逻辑，提高A*算法的搜索效率和路径安全性，使得机器人在温室环境下能够更加智能地寻找最优且安全的路径，在ROS的gazebo平台和实地的温室环境中验证算法的有效性。结果表明，在机器人运行速度≤0.6 m/s时，平均位置偏差为10.3 cm，满足番茄温室的作业要求。

关键词: 番茄, 温室机器人, 多传感器融合, 激光SLAM, 路径规划, 导航

CLC Number:

S625
TP24

Fu Honglong, , Hu Yubing, , Xie Limin, , Cai Yun, , Fang Bing, . Multi‑sensor fusion mapping and navigation research for tomato greenhouse robot[J]. Journal of Chinese Agricultural Mechanization, 2025, 46(4): 171-178.

傅泓龙, 胡裕兵, 谢立敏, 蔡云, 方兵, . 番茄温室机器人的多传感器融合建图与导航研究[J]. 中国农机化学报, 2025, 46(4): 171-178.

References

[ 1 ] 邢希君, 宋建成, 吝伶艳, 等. 设施农业温室大棚智能控制技术的现状与展望[J]. 江苏农业科学, 2017, 45(21): 10-15.
[ 2 ] 赵春江. 智慧农业的发展现状与未来展望[J]. 华南农业大学学报, 2021, 42(6): 1-7.
Zhao Chunjiang. Current situations and prospects of smart agriculture [J]. Journal of South China Agricultural University, 2021, 42(6): 1-7.
[ 3 ] 闫全涛, 李丽霞, 邱权, 等. 小型移动式农业机器人研究现状及发展趋势[J]. 中国农机化学报, 2019, 40(5): 178-186.
Yan Quantao, Li Lixia, Qiu Quan, et al. Research status and development trends of small‑mobile agricultural robots [J]. Journal of Chinese Agricultural Mechanization, 2019, 40(5): 178-186.
[ 4 ] 邢钦淞, 丁素明, 薛新宇, 等. 智能田间除草机器人发展现状研究[J]. 中国农机化学报, 2022, 43(8): 173-181.
Xing Qinsong, Ding Suming, Xue Xinyu, et al. Research on the development status of intelligent field weeding robot [J]. Journal of Chinese Agricultural Mechanization, 2022, 43(8): 173-181.
[ 5 ] 徐淑萍, 杨定哲, 房嘉翔, 等. 一种改进Cartographer算法的建图方法研究[J]. 激光杂志, 2024, 45(10): 86-93.
Xu Shuping, Yang Dingzhe, Fang Jiaxiang, et al. Research on a method of improving Cartographer algorithm [J]. Laser Journal, 2024, 45(10): 86-93.
[ 6 ] 黄禹翔, 吴国新, 左云波. 基于改进Cartographer的激光SLAM算法[J]. 北京信息科技大学学报(自然科学版), 2023, 38(2): 47-52.
Huang Yuxiang, Wu Guoxin, Zuo Yunbo. Laser SLAM algorithm based on improved Cartographer [J]. Journal of Beijing Information Science & Technology University, 2023, 38(2): 47-52.
[ 7 ] Dwijotomo A, Abdul Rahman M A, Mohammed Ariff M H, et al. Cartographer slam method for optimization with an adaptive multi‑distance scan scheduler [J]. Applied Sciences, 2020, 10(1): 347.
[ 8 ] 章弘凯, 陈年生, 代作晓, 等. 一种多层次数据融合的SLAM定位算法[J]. 机器人, 2021, 43(6): 641-652.
Zhang Hongkai, Chen Niansheng, Dai Zuoxiao, et al. A multi‑level data fusion localization algorithm for SLAM [J]. Robot, 2021, 43(6): 641-652.
[ 9 ] 贾浩. 基于Cartographer算法的SLAM与导航机器人设计[D]. 济南: 山东大学, 2019.
Jia Hao. Design of SLAM and navigation robot based on Cartographer algorithm [D]. Jinan: Shandong University, 2019.
[10] 庞永旭, 袁德成. 融合改进A*与DWA算法的移动机器人路径规划[J]. 计算机与现代化, 2022(1): 103-107.
Pang Yongxu, Yuan Decheng. Mobile robot path planning based on fusion of improved A* and DWA algorithms [J]. Computer and Modernization, 2022(1): 103-107.
[11] 王新彦, 盛冠杰, 张凯, 等. 基于改进A*算法和DFS算法的割草机器人遍历路径规划[J]. 中国农机化学报, 2023, 44(2): 142-147.
Wang Xinyan, Sheng Guanjie, Zhang Kai, et al. Traversal path planning of lawn mower robot based on improved A* algorithm and DFS algorithm [J]. Journal of Chinese Agricultural Mechanization, 2023, 44(2): 142-147.
[12] Mahmud M S A, Abidin M S Z, Mohamed Z, et al. Multi‑objective path planner for an agricultural mobile robot in a virtual greenhouse environment [J]. Computers and Electronics in Agriculture, 2019, 157: 488-499.
[13] 刘佳豪, 罗天放, 王桐. IMU和轮式里程计联合的雷达畸变校正算法[J]. 应用科技, 2023(5): 149-156.
Liu Jiahao, Luo Tianfang, Wang Tong. Radar distortion correction algorithm based on IMU and wheel odometer fusion [J]. Applied Science and Technology, 2023(5): 149-156.
[14] Jia B, Zhu A, Yang S X, et al. Integrated gripper and cutter in a mobile robotic system for harvesting greenhouse products [C]. 2009 IEEE International Conference on Robotics and Biomimetics (ROBIO). IEEE, 2009: 1778-1783.
[15] Xiong K, Zhang H Y, Chan C W. Performance evaluation of UKF‑based nonlinear filtering [J]. Automatica, 2006, 42(2): 261-270.
[16] 潘献飞, 宁治文, 王茂松, 等. 基于因子图的导航定位技术应用分析与思考[J]. 控制理论与应用, 2023, 40(12): 2130-2141.
Pan Xianfei, Ning Zhiwen, Wang Maosong, et al. Analysis and reflection on the navigation and positioning application based on factor graph [J]. Control Theory & Applications, 2023, 40(12): 2130-2141.
[17] 姚露, 聂晓根, 黄汉阳, 等. 无迹卡尔曼滤波算法对UWB/IMU组合定位的研究[J/OL]. 机械科学与技术, 1-10[2024-11-13]. https://doi.org/10.13433/j.cnki.1003-8728.20230271.
[18] 张振, 张华良, 邓永胜, 等. 融合改进A*算法与DWA算法的机器人实时路径规划[J]. 无线电工程, 2022, 52(11): 1984-1993.
Zhang Zhen, Zhang Hualiang, Deng Yongsheng, et al. Real time path planning of robot by combing improved A* algorithm and dynamic window approach [J]. Radio Engineering, 2022, 52(11): 1984-1993.
[19] 劳彩莲, 李鹏, 冯宇. 基于改进A*与DWA算法融合的温室机器人路径规划[J]. 农业机械学报, 2021, 52(1): 14-22.
Lao Cailian, Li Peng, Feng Yu. Path planning of greenhouse robot based on fusion of improved A* algorithm and dynamic window approach [J]. Transactions of the Chinese Society for Agricultural Machinery, 2021, 52(1): 14-22.

[1]	Ma Li, Cui Yabo. Path planning and control method for cooperative operation of plant protection UAV group [J]. Journal of Chinese Agricultural Mechanization, 2025, 46(4): 139-145.
[2]	Feng Haodong, Zheng Hang, , Zhang Yi, Xue Xianglei, , Tong Junhua, , Yu Guohong, . Design and navigation system experimentation of plant protection robots in ridge planting conditions [J]. Journal of Chinese Agricultural Mechanization, 2025, 46(3): 71-78.
[3]	Liu Qi, Dai Dongnan, Sun Mengyan, Ma Dexin, , Xu Yang. Surface defect recognition of cherry tomato fruits based on double attention fusion network structure [J]. Journal of Chinese Agricultural Mechanization, 2025, 46(3): 153-159.
[4]	Zhang Junning, Yan Ying, Hu Huan, Bi Zeyang, Xing Yu. Multi-target detection of cherry tomatoes under complex backgrounds based on Sim—YOLO [J]. Journal of Chinese Agricultural Mechanization, 2025, 46(3): 238-245.
[5]	Zheng Kang, , Han Changjie, Zhai Changyuan, You Jia, Xu Xiaobo. Design and experiment of row‑oriented spraying system of high clearance sprayer for seedling crops [J]. Journal of Chinese Agricultural Mechanization, 2025, 46(2): 98-104.
[6]	Zhao Ninglei, Cheng Man, Yuan Hongbo, Wang Yuan, Cai Zhenjiang. Design and experiment of autonomous inspection robot for sheep house [J]. Journal of Chinese Agricultural Mechanization, 2025, 46(1): 78-84.
[7]	Li Xin′ao, Liu Yuanyi, Wang Lijuan, Zhang Ce, Tao Lihuan, Zhang Yue. Design and experiment of closed-loop control system for ozone sterilization in facility agriculture [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(9): 62-68.
[8]	Sang Yinan, Xu Zenglai, Wang Qiong, Ge Haitao, Wang Dianguang. Design of a wheeled flower picking robot: Taking Abelmoschus manihot (Linn.) Medicus as an example [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(9): 202-208.
[9]	Li Juan, Jin Zhixiong. Path planning of crop inspection robot based on lightweight Transformer [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(9): 227-233.
[10]	Mou Yuanming, Zhuo Ran, Gao Fei. Path planning of agricultural mobile robot based on hybrid improved sparrow search algorithm [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(9): 234-243.
[11]	Xu Zhenhui, Li Xiaojuan. Research on tree trunk detection and navigation line fitting algorithm in orchard [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(8): 217-222.
[12]	Su Fei, , Wang Guanghui, Shi Yanxia, Jia Ran, Yan Yinfa, , Zu Linlu, . Leaf disease segmentation model of greenhouse tomatoes based on ResUnet with attention mechanism [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(8): 228-233.
[13]	Zhao Qingqing, Tian Yunchen, , Cui Zhiming, Li Jianbo, Ma Guoning, Sui Jinzhu. Design and test of automatic cleaning robot for landbased industrial aquaculture ponds [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(7): 68-74.
[14]	Li Xianna, Wu Qiang, Zhang Yidan, Zhou Kang. Detection of tomato leaf disease in small sample under selfsupervised learning [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(7): 172-179.
[15]	Huang Xiaoyu, Zhang Cong, Chen Xiaoling. Research on image recognition of shaded tomato diseases based on multiscale feature fusion [J]. Journal of Chinese Agricultural Mechanization, 2024, 45(7): 194-200.