李晨阳, 彭程, 张振乾, 苗艳龙, 张漫, 李寒. 融合里程计信息的农业机器人定位与地图构建方法[J]. 农业工程学报, 2021, 37(21): 16-23. DOI: 10.11975/j.issn.1002-6819.2021.21.003
    引用本文: 李晨阳, 彭程, 张振乾, 苗艳龙, 张漫, 李寒. 融合里程计信息的农业机器人定位与地图构建方法[J]. 农业工程学报, 2021, 37(21): 16-23. DOI: 10.11975/j.issn.1002-6819.2021.21.003
    Li Chenyang, Peng Cheng, Zhang Zhenqian, Miao Yanlong, Zhang Man, Li Han. Positioning and map construction for agricultural robots integrating odometer information[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2021, 37(21): 16-23. DOI: 10.11975/j.issn.1002-6819.2021.21.003
    Citation: Li Chenyang, Peng Cheng, Zhang Zhenqian, Miao Yanlong, Zhang Man, Li Han. Positioning and map construction for agricultural robots integrating odometer information[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2021, 37(21): 16-23. DOI: 10.11975/j.issn.1002-6819.2021.21.003

    融合里程计信息的农业机器人定位与地图构建方法

    Positioning and map construction for agricultural robots integrating odometer information

    • 摘要: 目前主流的农业机器人以低成本、低帧率的激光雷达作为即时定位与地图构建(Simultaneous Localization and Mapping, SLAM)的主要传感器,存在运动畸变和误匹配的问题。该研究针对这一问题提出了融合里程计信息的Gmapping建图算法,利用高频率里程计信息为每一个激光束匹配到近似的机器人位姿,获取机器人当前位姿下更为精确的激光数据,以减少激光雷达运动畸变对地图构建产生的影响。利用机器人搭载扫描频率为5 Hz的RPLIDAR A1激光雷达在玉米田及香蕉园中进行了SLAM建图精度测试试验。试验结果表明,在长度为12 m左右的玉米田区域,Gmapping建图算法的平均绝对误差为0.06 m,该研究算法建图平均绝对误差为0.01 m,相比于Gmapping建图算法降低了0.05 m,建图精度为99.5%;在长度为24.43 m的香蕉园区域,Gmapping建图算法的平均绝对误差为0.46 m,该研究算法建图平均绝对误差为0.07 m,相比于Gmapping建图算法降低了0.39 m,建图精度为99.1%。该研究算法有效地降低了低帧率激光雷达运动畸变对Gmapping建图的影响,可以基本满足农业环境下的高精度环境建图需求。

       

      Abstract: Abstract: A relatively low-cost and low frame rate lidar can be very popular to serve as the main sensor of Simultaneous Localization and Mapping (SLAM) in the mainstream agricultural robots at present. The lidar can scan the environment, while the pose of the robot can also change in the SLAM process. However, motion distortion and mismatching can often occur for the environment mapping, because one frame of lidar data can be obtained under the same pose of the robot by default. The resulting errors in the SLAM map can directly determine the accuracy of the automatic navigation of the robot. In this study, a commonly-used classical SLAM Gmapping was utilized to integrate the odometer information, to reduce the motion distortion of lidar with a low frame rate. The displacement and angle of the robot were directly measured with high accuracy of local position using an odometer, one type of important pose sensor in robots. An approximate odometer pose was also matched for each laser point in a frame of data that was scanned by lidar, according to the odometer information of high frequency. Among them, the odometer information was considered to be the collected laser points, thereby obtaining their coordinates after removing the motion distortion. Finally, the data was re-encapsulated to reduce the motion distortion of low frame rate lidar data on the map construction in this frame. A SLAM mapping test was also carried out to verify the improved Gmapping in a maize field and banana garden using a robot equipped with RPLIDAR A1 lidar with a scanning frequency of 5 Hz. The experimental results showed that the average absolute error of the improved Gmapping was 0.01 m in the maize field with a length of about 12 m, 0.05 m lower than that of the original one (0.06 m). In the banana garden area with a length of 24.43 m, the average absolute error of the improved Gmapping was 0.07 m, 0.39 m lower than that of the original one (0.46 m). Consequently, the mapping accuracy of the improved Gmapping was higher than before in the agricultural environment, indicating that the motion distortion of lidar with a low frame rate can be removed effectively.

       

    /

    返回文章
    返回