3D LiDAR感知的植物行信息提取方法与试验.pdf

赵润茂,朱政,陈建能,等.3DLiDAR 感知的植物行信息提取方法与试验 J.华南农业大学学报,2023,44(4):628-637.ZHAORunmao,ZHUZheng,CHENJianneng,etal.3DLiDARsensingmethodandexperimentofplantrowinformationextractionJ.JournalofSouthChinaAgriculturalUniversity,2023,44(4):628-637.3D LiDAR 感知的植物行信息提取方法与试验赵润茂1,2，朱政1，陈建能1,2，范国帅1，王麒程1，黄培奎3(1浙江理工大学机械与自动控制学院,浙江杭州310018；2浙江省种植装备技术重点实验室,浙江杭州310018；3华南农业大学工程学院,广东广州510642)摘要:【目的】针对林间或冠层下等卫星信号严重遮挡的区域，提出一种面向农业机器人导航环境感知的低成本3D 激光雷达(LiDAR)点云信息处理与植物行估计方法。【方法】利用直通滤波器滤除感兴趣区域外的目标无关点；提出均值漂移聚类、扫描区域自适应的方法分割每棵植物主干，垂直投影主干点云估算中心点；利用最小二乘法拟合主干中心，估计植物行。分别在开阔地的仿真果园与水杉树林进行模拟试验与田间试验，以植物行向量与正东方夹角为指标，计算本研究提出的方法识别的植物行信息与 GNSS 卫星天线定位测得的植物行真值间的角度误差。【结果】采用提出的 3DLiDAR 点云信息处理与植物行估计方法，模拟试验和田间试验对植物行识别误差平均值分别为 0.79和 1.48，最小值分别为 0.12和 0.88，最大值分别为 1.49和 2.33。【结论】车载 3DLiDAR 能够有效估计水杉树植物行。该研究丰富了作物识别思路与方法，为无卫星信号覆盖区域的农业机器人无图导航提供了理论依据。关键词:农业机器人；3D 激光雷达；点云处理；植物行识别；视场自适应；植物主干分割中图分类号:S24；TP242文献标志码:A文章编号:1001-411X(2023)04-0628-103D LiDAR sensing method and experiment of plant rowinformation extractionZHAORunmao1,2,ZHUZheng1,CHENJianneng1,2,FANGuoshuai1,WANGQicheng1,HUANGPeikui3(1FacultyofMechanicalEngineeringandAutomation,ZhejiangSci-TechUniversity,Hangzhou310018,China;2ZhejiangKeyLaboratoryofPlantingEquipmentTechnology,Hangzhou310018,China;3CollegeofEngineering,SouthChinaAgruiculturalUniversity,Guangzhou510642,China)Abstract:【Objective】Alow-cost3Dlightdetectingandranging(LiDAR)pointcloudinformationprocessingandplantrowestimationmethodforenvironmentperceptioninagriculturalrobotnavigationisproposedfortheareaswherethesatellitesignalisseriouslyoccludedintheforestorunderthecanopy.【Method】First,thepassthroughfilterwasusedtofilteroutthetargetirrelevantpointsoutsidetheareaofinterest.Secondly,themethodsofmeanshiftclusteringandscanningareaadaptationwereproposedtosegmentthetrunkofeachplant,andtheverticalprojectionofthetrunkpointcloudwasusedtoestimatethecenterpoint.Finally,theplantrowswereestimatedbydetermingthetrunkcenterswiththeleastsquarefittingmethod.Thesimulationexperimentandfieldexperimentwerecarriedoutinthesimulatedorchardandmetasequoiaforestintheopenfield.Theangle收稿日期：20220803网络首发时间：2023052508:17:25首发网址：https:/ positioning was calculated.【Result】Using the proposed method of 3D LiDAR point cloudinformationprocessingandplantrowestimation,theaverageerrorsofplantrowidentificationinsimulationexperimentandfieldexperimentwere0.79and1.48,theminimumerrorswere0.12and0.88,andthemaximum errors were 1.49 and 2.33,respectively.【Conclusion】The vehicle-mounted 3D LiDAR caneffectively estimate the plant rows of metasequoia.This research enriches the ideas and methods of cropidentification,andprovidesatheoreticalbasisforthemap-freenavigationofagriculturalrobotsinareaswithoutsatellitesignalcoverage.Key words:Agriculturalrobot;3DLiDAR;Pointcloudprocessing;Plantrowrecognition;Fieldofviewadaptation;Planttrunkdivision无人农场是智慧农业的一种生产方式，也是实现智慧农业的重要途径。农业机械自动导航作业是无人农场的关键技术1，而车体航向和位置的精准获取则是农机自动导航的前提2，目前，主要有全球导航卫星系统3-4(Globalnavigationsatellitesystem，GNSS)、立体相机5-6和激光雷达(Lightdetectingandranging，LiDAR)3 种感知系统。其中，采用载波相位差分(Real-timekinematic，RTK)技术进行定位解算的 GNSS 导航应用最为成熟并已在国际市场商业化，然而卫星通信因易受遮挡影响出现差分失锁或多路径效应，通常用于开阔地作业场景，不适于如林间或冠层下卫星信号盲区的特殊作业环境7-8。立体视觉通过彩色相机对环境成像，采用数字图像处理算法或神经网络深度学习模型分析提取图像中的有用信息，为机器人路径规划提供参考9-10，但视觉成像质量极易受光照影响，定位精度表现不稳定11。利用飞行时间(Timeofflight，ToF)原理，2DLiDAR 可全天候获得传感器极坐标系中载体周围环境的二维坐标，但由于点云数据稀疏，小尺寸目标特征信息易缺失，因此更多用于植保12、收获13或变量作业14时大表面积冠层检测15，如蔡吉晨16依据果树冠层网格化体积模型设计了变量喷药策略，试制了基于 2DLiDAR 的果园变量喷药机样机；薛秀云等17通过LiDAR 检测技术提出表征树冠特征参数的叶墙面积及其关联变量喷雾模型，比采用纯对靶定量喷雾省药 32.77%；侯加林等 1 8 采用基于机器人操作系统(Robotoperatingsystem，ROS)框架工作的开源 cartographer算法，研制了双激光雷达温室运输机器人导航系统，但导航路径规划必须在地图信息已知的前提下进行。3DLiDAR 具有更大视场，能提供更丰富的环境感知信息，可精准地表达三维模型表面特性和几何形状19，广泛用于轿车自动驾驶系统的局部路径规划20-22；因为硬件成本和数据计算负担限制，在农业工程领域，3DLiDAR 主要用于基础科学研究，如农植物几何参数获取 2 3-2 4、表型 2 5 和逆向重构26等，苏伟等27提出一种基于地面激光扫描技术的大田玉米个体表型信息提取方法，陈日强等28利用无人机搭载 3DLiDAR 测量每棵果树的树冠面积和直径，并分析了空间分辨率对单木树冠检测与提取结果的影响；刘路等29采用了Velodyne16 线激光雷达(VLP-16)解析高遮挡环境下玉米植物行中心导航线，但传感器成本较高且未考虑载体姿态变化对植株定位的影响；为实现低成本 3D 感知，刘宽30、Gasparino 等31采用舵机驱动 2DLiDAR 定轴摆动，研制了摆头式 3DLiDAR 探测系统，由于需要实时测量 LiDAR 姿态，并涉及多坐标系统配准，工程化实施难度大。本文针对林间或冠层下 GNSS 信号遮挡严重区域的农业机器人导航需求，提出一种低成本 3DLiDAR 感知的点云数据处理与植物行信息提取方法。该方法不仅能够补偿载体姿态变化对点云空间坐标的影响，还可实现不同直径的植株主干自适应分割，避免重叠交错枝叶影响植株中心求取；最后，开展模拟试验和实地试验对算法精度的有效性进行验证。1 系统组成与坐标标定 1.1 试验材料1.1.13DLiDAR采用 LivoxHorizon3DLiDAR 作为农业机器人导航的感知传感器，3DLiDAR 的扫描量程为 0.5260.0m，水平视场为 81.7，垂直视场为 25.1，每秒可输出点云 240000第4期赵润茂，等：3DLiDAR 感知的植物行信息提取方法与试验629rp个。当 LiDAR 激光束遇到障碍物时发生反射，测量反射时间来确定距离 3 2。内置惯性测量单元(Inertialmeasurementunit，IMU)，通过测量农业机器人行驶过程中的横滚角，俯仰角，航向角，对 LiDAR 输出的点云坐标 xlidar、ylidar、zlidar进行实时姿态校正，使测量结果不受载体运动姿态影响，在出厂前已完成 LiDAR 与 IMU 的外参标定和同步。校正公式如下：RIMU=RZRYpRXr=cossin0sincos0001cosp0sinp010sinp0cosp1000cosrsinr0sinrcosr=coscospsincosr+cossinpsinrsinsinr+cossinpcosrsincospcoscosr+sinsinpsinrcossinr+sinsinpcosrsinpcospsinrcospcosr，(1)xmixymixzmix=xlidarylidarzlidarRIMU，(2)式中：RIMU为 IMU 的旋转矩阵，xlidar、ylidar、zlidar为LiDAR 的点云坐标，xmix、ymix、zmix为校正后的LiDAR 点云坐标。相比于常规多线机械旋转式 3DLiDAR，LivoxHorizon 采用非重复扫描方式获取传感器与环境的距离，扫描时间超过 0.1s 的时候，可以达到常见64 线机械旋转式激光雷达扫描覆盖率；达到 0.5s左右时，视场覆盖率将接近 100%，价格仅有国外同类 64 线产品的 1/501/100；因此，研究选用 LivoxHorizon 作为植物行感知传感器，且其小视场、非重复式扫描的特点非常适于封闭、低速的农业机器人导航环境。1.1.2GNSS 定位系统为评价本文提出的作物行提取精度，以 GNSS 天线定位数据作为环境信息位置真值。GNSS 采用天宝定位板卡 BD970 接收解析卫星信号，千寻连续运行参考站(Continuouslyoperatingreferencestations，CORS)提供基于RTK 的定位信息，能实现 12cm 的定位精度。通过将位置已知基准站测量的伪距修正值或相位信息发送到移动站来提高精度，并将定位数据通过串口以 GNGGA、GNVTG 的形式输送至上位机。1.1.3机器人底盘采用的四轮差速转向机器人如图1所示，结构尺寸(长宽高)为830mm650mm370mm，底盘高度为 120mm，轮胎为直径 300mm的真空胎，最高时速为 8km/h，轮胎减震且具有自适应悬挂，提高了在越野路面的行驶通过性，适用于农业环境下工作。1.2 采用的坐标系统1.2.1坐标系统定义WGS-84 大地坐标系：该坐标反映了地球表面各点的空间分布，是为全球定位系统(Globalpositioningsystem，GPS)的使用而建立的一种通用地心坐标系；研究使用的 GNSS 接收机输出的经纬度坐标即是WGS-84 坐标下天线的定位。传感器坐标系：即 LiDAR 坐标系，如图 1 所示，原点在高于 LiDAR 底部 50.1mm 的透镜中心，在笛卡尔右手坐标系下定义 Y 轴正方向指向传感器正前方，Z 轴过传感器形心垂直于水平面。LiDAR内置的 IMU 坐标原点 OI在 LiDAR 坐标系上的坐标为(55.12，22.26，29.70)(单位：mm)。导航坐标系：通过高斯吕格投影先将 WGS-84 大地坐标系的经纬度信息转化到局部切平面坐标系，X 轴指向地理北方，Y 轴指向东方，再经坐标平移至导航坐标系，本研究拟进行的数据处理及分析均在导航坐标系下进行。FEFE1.2.2坐标系统转换IMU 校正后的 LiDAR 输出数据是 IMU 系下的环境信息坐标，已与导航系东北平面平行，还需进行航向标定。如图 2 所示，E、F、G 是 GNSS 天线在导航坐标系下的位置，分别记为(xi，yi，zi)(i=1,2,3)，采用隐式(3)计算 LiDAR 坐标系原点在导航系下的位置，记为(x，y，z)。LiDAR 坐标系与导航坐标系的航向偏差 yaw 为的航向角与航向角的差值，代入式(4)求解XN(东 East)YN(北 North)ZNONXIYLZIOLXLZLOIYI导航坐标系 Navigation coordinate systemLiDAR 坐标系 LiDAR coordinate systemIMU 坐标系 IMU coordinate system图 1 轮式机器人与传感器坐标系Fig.1 Wheeled robot and sensor coordinate system630华南农业大学学报(https:/ LiDAR 原点坐标(xN，yN，zN)。Li=(xxi)+(yyi)+(zzi),i=1,2,3,(3)xNyNzN1=cos(yaw)sin(yaw)00sin(yaw)cos(yaw)0000100001xyz1。(4)1.3 研究方法1.3.1点云信息预处理LiDAR 视场为圆锥面，每秒最多获得 240000 个点，最大探测距离可达 260m，在数据采集的过程中会引入大量的目标无关点，比如杂草、地面、周围的建筑物，保留其原始探测范围会在探测到更多目标信息的同时增加处理工作量，延长数据处理时间33；另外，距离传感器越远，LiDAR 测得的点云变得稀疏，所能提供可利用的有效信息变少，因此，需要在不改变点云特征的前提下实时对数据进行预处理，具体步骤如下。1)感兴趣区域和降采样以 LiDAR 的安装位置为原点，移动机器人的航向为Y轴，建立直角坐标系。根据葡萄田环境，通过直通滤波分别在 X 轴、Y 轴和 Z 轴设置 6、12和 2m 的感兴趣区域(Regionofinterest,ROI)。直通滤波处理点云的具体计算式如式(5)所示。并采用体素滤波对 ROI 区域内的点云进行降采样，体素单元大小为 0.1m0.1m0.1m。估计每个立方体的形心坐标，以其代表立方体内的所有点云输出。直通滤波与体素滤波能在避免缺失点云特征的前提下有效降低点云数据，加快数据处理速度。dst(u,v,w)=src(u,v,w)，dmin src(u,v,w)dmax，0，其他，(5)式中，(u,v,w)为雷达点云的位置坐标，m；dst(u,v,w)为 ROI 区域内的点云坐标，m；src(u,v,w)为原始点云坐标，m；dmin为直通滤波下限，m；dmax为直通滤波上限，m；dmax取值为 LiDAR 正前方 34 株植物株距。2)地面点云分割采用 RayGroundFilter 分割地面点云，具体方法如下：首先，按照 LiDAR 水平角分辨率将点云剖分为 3600.2=1800 个纵截面，并将每个纵截面内的点按照距离远近排序；其次，设定同条扫描线上邻近两点的坡度阈值(local_max_slope)和整个地面的坡度阈值(general_max_slop)，并根据这 2 个坡度阈值以及当前点的半径(到 LiDAR 的水平距离)求得高度阈值；最后，若当前点的高度值在地面加减高度阈值范围内，则判定为地面点并删除。3)半径滤波受系统测量噪声和环境特性等干扰因素的影响，3DLiDAR 点云存在部分离群点，在数据特征上表现为远离目标点云，应当滤除。采用半径滤波去除主干周围的离群点云。半径滤波方法运行速度快，并且依序迭代留下的点一定是最密集的，极其适用于点云数据量大、实时性要求高的场景，流程如图 3 所示。1.3.2植物中心点提取为获取植物主干区域，提取中心点，刘路等29采用了将三维点云投影到二维平面后再进行 k-mean 聚类的方式，对于未知环境的点云，这种方法难以预先确定聚类簇的数量，部分枝叶的点云也会因相互遮挡难以采集，导致聚类得到的中心点会有较大误差；而 DBSCAN 聚类算法，由于离 LiDAR 较近的数据点密度高，在聚类半径相同的情况下，会存在距离较近且较细的杂草枝叶与距离较远且直径较大的树干相比接收到的数据点数量接近甚至更多的现象，从而出现大量误判与漏检；而均值漂移聚类算法受异常值的影响较小，而且能在未知环境下对数据进行聚类，具体流程如下：XIYIZIOIXN(东 East)YN(北 North)ZNON76 mmL1L2L3F(F)E(E)位置 3Position 3G(G)位置 2Position 2位置 1Position 150 mmLi为 LiDAR 测得天线中心点的极径；E、F、G 为导航坐标系下GNSS 天线位置；E、F、G为 IMU 坐标系下 GNSS 天线位置；ONXNYNZN为导航坐标系；OIXIYIZI为 IMU 坐标系LiisthepolardiameterofthecenterpointoftheantennameasuredbyLiDAR;E，FandGareGNSSantennapositionsinthenavigationcoordinatesystem;E，FandGareGNSSantennapositionsintheIMUcoordinatesystem;ONXNYNZNisthenavigationcoordinatesystem;OIXIYIZIistheIMUcoordinatesystem图 2 导航坐标系与 IMU 坐标系相对位置Fig.2 Relative position of navigation coordinate systemand IMU coordinate system第4期赵润茂，等：3DLiDAR 感知的植物行信息提取方法与试验6311)在随机一块植物点云中任取一点 x 作为中心点；xi2)找出离中心点 x 距离在带宽之内的所有点，记做集合 M，认为这些点属于簇 c；3)如公式(6)所示，计算从中心点开始到集合M 中每个元素的向量，将这些向量相加，得到偏移向量 M(x)；4)中心点沿着漂移均值点的方向移动，移动距离是偏移向量的模；5)重复步骤 2)4)，直到偏移向量的大小满足设定的阈值要求并且逐渐收敛，记住此时的中心点；6)重复 1)5)直到所有的点都被归类。M(x)=1kxisr(xix)，(6)式中，Sr为以 x 为圆心、r 为半径的圆形区域，m；k 为包含在 Sr范围内的点的个数；xi为包含在 Sr范围内的点。由于植物间交错的枝叶会影响到植物中心点的判断，因此，必须利用植物的主干信息提取植物行；同时，每株植物枝叶位置随机生长，如图 4 所示，机器人在前进过程中，3DLiDAR 视场随载体运动状态发生变化，而固定参数的直通滤波器不能准确分割植物主干部分的点云。综上，研究提出一种扫描区域自适应的主干中心点提取方法：如图 5 所示，对每一棵植物的点云沿着高度方向取每层 h 进行层切34，分别搜索每层切片点云中点集在 X 轴和Y 轴方向的最大值 xmax、ymax与最小值 xmin、ymin，根据植物的主干直径与枝叶直径设定阈值35dx、dy,保留同时满足 X 轴、Y 轴阈值条件的点云，自动筛选植物主干部分点云，目标点云的具体表达式如式(7)所示：dst(x,y,z)=src(x,y,z)，0 xmaxxmin dx 且0 ymaxymin dy，0，其他，(7)式中，(x,y,z)为分类后每层点云的位置坐标，m；dst(x,y,z)为目标点云坐标，m；src(x,y,z)为原始点云坐标，m；dx为 X 轴方向的阈值，m；dy为 Y 轴方向的阈值，m。主干分割后再进行垂直投影，得到的点云团相对稠密且离群点少，避免了枝叶点云的影响，通过输入点云Input point cloud设置点云搜索半径Set point cloud search radius设置半径内点集的阈值Set the threshold for point sets within the radius判断为有效点云并保存Determine as a valid pointcloud and save it开始Start判断是否在设定的阈值范围内Determine if it is within the setthreshold range结束End是 Yes否 No判断为离群点云并移除Determine as an outlier pointcloud and remove图 3 半径滤波流程图Fig.3 Flow chart of radius filteringROI位置 1Position 1位置 2Position 2位置 3Position 3图 4 不同位置的 LiDAR 扫描植物Fig.4 Scanning plants by LiDAR at different positions632华南农业大学学报(https:/ 变换法和最小二乘法等。其中 RANSAC 运算速度较慢，随机性较高36，且 LiDAR 扫描点云的疏密程度受植株距离的影响，导致 RANSAC 拟合的路径与真实的路径有所偏差；Hough 变换法虽然是应用最广泛的直线监测方法，有较好的鲁棒性并且受噪声影响小，但 Hough变换时间复杂度与空间复杂度较高；与上述 2 种方法相比，根据植物中心点通过最小二乘法检测路径，误差小，速度快，更符合实际应用需求，具体计算式为(8)(10)：y=ax+b，(8)Se2=f(xi)yi2=(axi+byi)2,(9)aSe2=2(axi+byi)xi=0,bSe2=2(axi+byi)=0,(10)Se2式中，y 为假设植物行的线性方程；为总误差平方和；xi为植物主干中心点 x 坐标；yi为植物主干中心点 y 坐标；a、b 为常数。1.4 植物行提取方法的精度验证为验证通过上述方法拟合的植物行精度，进行了 LiDAR 识别植物行的精度验证试验。常用作真值参考的 RTK-GNSS 定位方法在树林场景中失效，一些常用的室内定位手段，如超宽带(Ultrawideband，UWB)技术，精度较低，为 510cm。因此，参照文献 29 和 37 中的方法，在开阔地建立仿真果园，使用 RTK定位系统验证所提出算法的精度。如图 6a 所示，采用粘贴有芦苇叶且直径不同的塑料圆管模拟植物，每根圆管高为 1m，直径 2550mm，其中一次试验排列方式如图 6b 所示。使用LiDAR 获取模拟植物的点云信息并通过 LiDAR 内置 IMU 进行姿态校正，得到导航坐标系下的点云；再将 GNSS 天线分别放置在每个圆管的圆心处得到每个圆管圆心处的经纬度信息，采用高斯吕格投影38，将 GNSS 天线采集的坐标数据从 WGS-84 坐标系也转化至导航坐标系下以获取模拟植物位置真值，测量一段时间，取平均值；最后用最小二乘法分别对 LiDAR 点云和植物坐标真值进行直线拟合，并根据拟合的直线倾角评价二者结果，验证算法的精度。hxminxmaxh 为切片高度；xmin、xmax分别为每层切片点云中点云在 X 轴方向的最大值和最小值histhesliceheight;xminandxmaxaretheminimumandmaximumvaluesofthepointcloudintheX-axisdirectioninpointcloudofeachslicelayer图 5 高度自适应点云分割Fig.5 Highly adaptive point cloud segmentation32 mm25 mm50 mm40 mm81.7a：试验现场a:Testing siteb：模拟植物分布情况b:Simulated crop distribution图 6 搭建仿真果园进行模拟试验验证提取的植物行精度Fig.6 Build a simulation orchard for simulation experiments to verify the accuracy of extracted plant rows第4期赵润茂，等：3DLiDAR 感知的植物行信息提取方法与试验633每完成一次扫描感知后，任意改变圆管的排布位置，进行下一次扫描，试验共进行 3 次。2 结果与分析 2.1 LiDAR 植物行识别结果其中一组试验的算法各步处理结果如图 7 所示，具体步骤如下：1)LiDAR 扫描模拟植物并经过直通滤波选择ROI 如图 7a 所示，此时点云图中有较多的大尺度噪点，使用半径滤波去除噪点得到图 7b 所示的点云，完成点云的预处理；2)通过均值漂移聚类将每株植物进行分类得到图 7c 结果，将每棵模拟植物进行高度自适应分割点云，去除枝叶部分点云，保留主干部分点云，效果如图 7d；3)将得到的主干部分点云投影到大地平面，分别取平均值找到每棵模拟植物的中心点，如图 7e；4)利用最小二乘法拟合模拟植物中心直线方程，结果如图 7f 所示。b：半径滤波b:Radius filterc：均值漂移滤波c:Mean shift filterf：最小二乘法f:Least square methode：垂直投影e:Vertical projectiond：高度自适应分割枝叶与茎秆d:Highly adaptive segmentation ofleaves and stems a：直通滤波a:Pass through filter左侧植物行Left plant row右侧植物行Right plant row模拟植物中心点Center point of simulated plant模拟植物中心点Center point ofsimulated plant2.53.03.54.04.50.500.51.00.200.20.40.60.80.750.500.250Y/mX/mZ/m2.53.03.54.04.50.500.500.20.4Y/mX/mZ/m2.53.03.54.04.50.500.51.00.200.20.40.60.80.750.500.250Y/mX/mZ/m340.500.51.000.250.500.75Y/mX/mZ/m2.50.500.2500.250.500.753.03.54.04.5Y/mX/m2.52.00.500.2500.250.500.753.0 3.5 4.05.04.5Y/mX/m图 7 植物点云拟合流程Fig.7 Plant point cloud fitting process由于采用直尺测量模拟作物间的相对位置作为定位真值，易产生较大的累计或坐标系对齐误差，因此，本试验以 RTK-GNSS 定位为真值，以直线方程与导航坐标系正东方向夹角为指标，评价算法精度。针对其中一次试验，分别采用 LiDAR 和RTK-GNSS 天线定位，采集模拟植物的定位信息。根据上述试验方法，调整模拟植物的间距以及排列方式，控制农业机器人收集点云数据并提取植物行，如图 8a 所示。用 GNSS 天线采集每组模拟植物的坐标真值，如表 1 所示，并同样利用最小二乘法将坐标真值拟合成直线方程，如图 8b 所示。分析并统计每次试验中农业机器人识别到的植物行与行真值直线方程间的误差。2.2 精度验证结果将导航坐标系和 LiDAR 坐标系标定、投影之后，直线方程斜率即为与正东方夹角，根据上述试验的结果，通过计算每组试验对应的植物行与正东方的夹角判断试验的精度，试验共进行 3 次，每次对 2 行模拟植物进行扫描估计，得到 6 条直线方程，结果如表 2 所示。基于植物行与正东方的夹角，LiDAR 识别植物行夹角平均绝对误差为 0.79，最小绝对误差为 0.12，最大绝对误差为 1.49。误差产生的可能原因包括传感器与 GNSS 的测量误差、LiDAR 坐标系与导航坐标系的标定误差、LiDAR 的安装误差、数值计算误差以及最小二乘法拟合产生的误差等，但不影响导航或者小车通过。2.3 田间试验为验证提出算法的有效性，在浙江理工大学的水杉树林(图 9，树的直径为 200400mm)开展田间验证试验，将小车行驶至树林某一位置利用 3D634华南农业大学学报(https:/ 扫描树木，记录 3 组试验的点云数据，并以小车初始位置为原点，建立导航坐标系，通过卷尺测量水杉树到小车的距离作为植物坐标真值，利用最小二乘法对植株真值坐标进行拟合，与处理LiDAR 点云(图 10a)提取的植物行对比，验证田间试验精度。植株行拟合结果如图 10b所示。试验数据如表 3 所示，田间试验中采用本文提出的方法得到的植物行角度与真实的植物行角度平均绝对误差为 1.48，最小绝对误差为 0.88，最大绝对误差为 2.33。相比于模拟试验，误差有所提升；误差提升的可能原因包括卷尺测量实际植物中心产生的测量误差、小车重复试验产生的初始偏201.00.80.60.40.20.20.40.6025y2=0.010 x20.828y1=0.038x1+0.593y2=0.028x2+2.458y1=0.012x1+3.883303540Y/ma：LiDAR 估计模拟植物中心点及拟合的植物行a:LiDAR estimation of simulated plant center pointsand fitted plant rowsb：GNSS 测量得到的模拟植物坐标真值及拟合的植物行b:True values of simulated plant coordinates measuredby GNSS and fitted plant rows2025303540Y/mX/m2.42.62.83.03.23.63.84.03.4X/m左侧植物行Left plant row右侧植物行Right plant row模拟植物中心点Center point of simulated plant图 8 第 3 组试验中模拟植物在全局坐标系下的坐标并通过最小二乘法提取植物行Fig.8 The coordinates of plants in the global coordinate system are simulated and the plant rows are extracted by leastsquare method in the third experiment图 9 机器人在水杉树林进行田间试验Fig.9 Robots conducting field experiments in metasequoiaforests表 1 模拟植物坐标 GNSS 测量值1)Table 1 GNSS measurements of simulated plant coordinates试验Test左侧植物行Leftplantrow右侧植物行Rightplantrow(x1,y1)(x2,y2)(x3,y3)(x4,y4)(x5,y5)(x6,y6)(x7,y7)(x7,y7)1(3.528,5.666)(4.145,5.682)(4.797,5.633)(5.494,5.756)(5.424,6.895)(4.827,6.915)(4.054,6.989)(3.602,6.997)2(2.091,3.605)(2.683,3.522)(3.312,3.627)(3.960,3.445)(2.062,2.158)(2.753,2.187)(3.253,2.007)(3.822,2.201)3(2.126,3.914)(2.803,3.738)(3.447,3.899)(4.112,3.837)(2.258,2.562)(2.844,2.444)(3.532,2.639)(4.174,2.553)1)(xi,yi)为GNSS测量得到的每株模拟植物的坐标1)(xi,yi)isthecoordinateofeachsimulatedplantobtainedbyGNSSmeasurement表 2 模拟试验中基于植物行与正东方的夹角判断 LiDAR识别植物行精度Table 2 Aaccuracy evaluation of LiDAR recognition ofplant rows based on the angle between the plantrows and due east in simulation experiment植物行序号Plantlinenumber夹角真值/()TruevalueoftheangleLiDAR识别夹角/()AngleidentifiedbyLiDAR绝对误差/()Absoluteerror11.971.570.4023.554.651.1033.492.920.5740.400.520.1250.692.181.4961.600.571.03第4期赵润茂，等：3DLiDAR 感知的植物行信息提取方法与试验635差、LiDAR 坐标系与导航坐标系的标定误差、LiDAR 的安装误差、数值计算误差以及最小二乘法拟合产生的误差等，但不影响导航或者小车通过。田间试验表明，利用本文提出的方法，农业机器人能实现在未知环境下对植物行信息的有效估计。3 结论1)针对林间或冠层下 GNSS 信号遮挡严重的区域，提出一种低成本 3DLiDAR 感知点云数据处理与植物行信息提取方法，该方法可利用 3DLiDAR 内置 IMU 补偿载体运动姿态变化对采集的点云空间坐标的影响。2)为避免枝叶影响算法对植株中心的判断，提高算法参数对由于机器人运动导致的 LiDAR 视场变化的适应性，设计了一种植物行估计算法。先后采用均值漂移聚类、扫描区域自适应的方法分割每棵植物的主干，垂直投影主干点云估算植物中心点，最后利用最小二乘法提取出植物行信息。3)为评价研究提出的基于 3DLiDAR 的植物行识别精度，进行了精度验证试验与田间试验，以植物行向量与正东方夹角为指标，比较研究提出的方法识别的植物行信息与卫星天线定位测