• 《中国科学引文数据库(CSCD)》来源期刊
  • 中国科技期刊引证报告(核心版)期刊
  • 《中文核心期刊要目总览》核心期刊
  • RCCSE中国核心学术期刊

基于密度自适应的RANSAC非结构化环境下果园机器人导航

褚福春, 宫金良, 张彦斐

褚福春, 宫金良, 张彦斐. 基于密度自适应的RANSAC非结构化环境下果园机器人导航[J]. 华南农业大学学报, 2022, 43(5): 99-107. DOI: 10.7671/j.issn.1001-411X.202111025
引用本文: 褚福春, 宫金良, 张彦斐. 基于密度自适应的RANSAC非结构化环境下果园机器人导航[J]. 华南农业大学学报, 2022, 43(5): 99-107. DOI: 10.7671/j.issn.1001-411X.202111025
CHU Fuchun, GONG Jinliang, ZHANG Yanfei. Orchard robot navigation in unstructured environment based on density adaptive RANSAC[J]. Journal of South China Agricultural University, 2022, 43(5): 99-107. DOI: 10.7671/j.issn.1001-411X.202111025
Citation: CHU Fuchun, GONG Jinliang, ZHANG Yanfei. Orchard robot navigation in unstructured environment based on density adaptive RANSAC[J]. Journal of South China Agricultural University, 2022, 43(5): 99-107. DOI: 10.7671/j.issn.1001-411X.202111025

基于密度自适应的RANSAC非结构化环境下果园机器人导航

基金项目: 山东省引进顶尖人才“一事一议”专项经费(鲁政办字[2018]27号);山东省重点研发计划(重大科技创新工程)(2020CXGC010804);山东省自然科学基金(ZR202102210303);淄博市重点研发计划(校城融合类)生态无人农场研究院项目(2019ZBXC200)
详细信息
    作者简介:

    褚福春,硕士研究生,主要从事农业机器人自主导航技术研究,E-mail: 1371368298@qq.com

    通讯作者:

    宫金良,副教授,博士,主要从事机器人与智能农机装备研究,E-mail: gjlwing@qq.com

  • 中图分类号: S224;S628

Orchard robot navigation in unstructured environment based on density adaptive RANSAC

  • 摘要:
    目的 

    提出一种基于多传感器融合的果园导航方案,解决果园机器人在GPS导航过程中受果树遮挡导致信号弱、定位效果差的问题。

    方法 

    通过16线激光雷达采集高精度的三维点云数据,利用Voxel grid filter滤波算法进行点云预处理,降低点云密度并去除离散点,将果树行通过欧几里类算法进行聚类,采用改进的随机采样一致性 (Random sample consensus, RANSAC) 算法拟合出果树行直线,根据平行直线的关系,推算得到导航线,并融合惯性测量单元(Inertial measurement unit, IMU)对果园机器人进行高精度定位。基于差速转向和纯追踪模型进行轨迹跟踪,实现果园机器人在果树行间自主导航以及自动换行的目标。

    结果 

    在将激光雷达和IMU的数据进行融合后,获取到果园机器人的准确位姿,当机器人以速度0.8 m/s在果园作业时,对比最小二乘法和传统RANSAC法产生的偏差,基于密度自适应RANSAC法产生的横向偏差不超过0.1 m、航向角偏差不超过1.5°,均为3种方法中的最小值。但当机器人速度增加到1.0 m/s时,各项偏差均明显增大。

    结论 

    本文提出的基于多传感器融合的果园机器人导航技术适用于大多数规范化果园,具有重要推广价值。

    Abstract:
    Objective 

    An orchard navigation scheme based on multi-sensor fusion was proposed to solve the problems of weak signal and poor positioning effect caused by tree occlusion in the GPS navigation process of orchard robot .

    Method 

    High-precision 3D point cloud data were collected by 16-line lidar, point cloud was preprocessed by Voxel grid filter algorithm, point cloud density was reduced and discrete points were removed, fruit tree rows were clustered by Euclidian algorithm, and the straight lines of fruit tree rows were fitted by improved random sampling consistency (RANSAC) algorithm. According to the relationship of parallel lines, the navigation line was calculated and integrated with inertial measurement unit (IMU) for high-precision positioning of orchard robot. Based on differential steering and pure tracking model, the goal of autonomous navigation and automatic line wrapping of orchard robot was realized.

    Result 

    After the data fusion of lidar and IMU, the accurate position and pose of the robot were obtained. Compared with the deviation produced by the least square method and the traditional RANSAC method, the lateral deviation based on density adaptive RANSAC method was less than 0.1 m and the heading angle deviation was less than 1.5° when the robot was operating in the orchard at the speed of 0.8 m/s. The deviations were the minimum in the three methods. However, when the robot speed increased to 1.0 m/s, all the deviations increased obviously.

    Conclusion 

    The orchard robot navigation technology based on multi-sensor fusion proposed in this paper is suitable for most standardized orchards and has important promotion value.

  • 禽白血病是由禽白血病病毒(Avian leukemia virus,ALV)引起的一类禽免疫抑制性肿瘤性传染病。可自然感染鸡群的禽白血病病毒包括ALV-A~E、J 和K 7个亚群,其中ALV-A是引起我国鸡群发生禽白血病的主要病原[1-2]。ALV-A可使感染鸡群产生免疫抑制、生产性能下降,乃至发生特征性肿瘤而死亡,给养禽业造成巨大的经济损失[3-4]。目前,该病鲜有商品化疫苗和有效的治疗方法,主要通过净化种群和生物安全措施进行预防[5]。然而,近年来禽白血病的流行病学调查研究发现,ALV-A在我国地方鸡种[6-7]、商品肉鸡[8]、蛋鸡[9]及野生鸟类[10]中普遍存在。可见,现有措施并不能完全控制A亚群禽白血病在中国的发生与流行,该病已成为威胁我国养鸡业(尤其是种鸡业)可持续健康发展的重大疾病之一。因此,研发更适合防控我国A亚群禽白血病的新策略已迫在眉睫。国外已有研究证实,提高宿主对A亚群禽白血病的遗传抗性,开展A亚群禽白血病的抗病育种可成为防控该病的有效策略[11-13]

    ALV-A由tva受体基因编码的细胞表面特异性受体Tva介导侵入宿主细胞,继而发生感染[14]tva受体基因的遗传突变会导致Tva受体蛋白的完全缺失或表达一个不适宜作为ALV-A受体的缺陷型Tva受体蛋白,从而引起宿主细胞对ALV-A的感染产生遗传抗性[15]。在国外白来航近交品系tva受体基因中已经鉴定了tvar1tvar2tvar3tvar4 4个ALV-A遗传抗性位点[16-17]。Chen等[18]首次从中国鸡种中成功鉴定了tvar5tvar6 2个ALV-A遗传抗性位点。另外,我们前期研究(未发表)发现中国鸡种tva受体基因存在新的自然突变位点:tva基因编码区第3位碱基由G突变为A,推测该突变引起tva基因起始密码子序列由ATG突变为ATA,将该tva基因自然突变命名为tva c.3G>A,但其对宿主感染A亚群禽白血病病毒的影响尚不清楚。因此,本研究拟通过ALV-A体外感染试验和体内攻毒试验,从体外、体内2个层面验证tva c.3G>A突变是否引起宿主对ALV-A的感染产生遗传抗性,以期鉴定新的ALV-A遗传抗性位点。

    黄羽肉鸡品系CB01~CB15[19]抗凝血样采自于温氏食品集团股份有限公司,每个品系随机采取36~60份血样,共670份血液样品。1日龄无特定病原(Specific pathogen free,SPF)鸡苗购自广东大华农有限公司。ALV-A GD08株、DF-1细胞系为广东省畜禽健康养殖与环境控制重点实验室保存。RCASBP(A)-GFP重组质粒为广东省畜禽健康养殖与环境控制重点实验室前期构建并保存[18]

    血液/细胞/组织基因组DNA提取试剂盒购自天根生化科技(北京)有限公司;质粒小量提取试剂盒、无内毒素质粒大量提取试剂盒、凝胶 DNA回收试剂盒均购自OMEGA公司;ReverTra Ace®qPCR RT Kit、KOD-FX购自Toyobo公司;FastStart SYBR Green Master(Rox)购自Roche公司;反转录试剂盒、pMD19-T、PrimeScript® One Step RT-PCR Kit购自Takara公司;Opti-DMEM无血清培养基、DMEM细胞培养基、胎牛血清、胰蛋白酶、青链霉素均购自Gibco公司;TRIZOL reagent、Lipofectamine 3000转染试剂购自Invitrogen公司。

    参考NCBI数据库中鸡tva基因的DNA序列(GenBank登录号:AY531262.1),应用 Primer 5.0软件设计3对引物,分3个片段(1、2和3段)PCR扩增tva基因全长序列3 607 bp,引物信息见表1。提取黄羽肉鸡品系CB01~CB15血液样品的基因组DNA,用该3对引物PCR扩增tva基因全长序列。将PCR扩增产物送生工生物工程(上海)股份有限公司测序,应用DNAstar和Mutation Surveyor基因序列分析软件比对tva基因序列和测序序列,分析黄羽肉鸡品系tva基因的遗传变异,对tva c.3G>A突变位点进行基因分型。

    表  1  tva受体基因全长序列PCR扩增引物信息
    Table  1.  Primers used to amplify the whole sequence of tva receptor gene
    片段 Fragment 引物名称 Primer name 引物序列(5′→3′) Primer sequence 退火温度/℃ Annealing temperature 片段大小/bp Segment size
    1 P1-F GTTCAGCAGATCCTCATCTCCCG 62 1308
    P1-R GGCCATTGTGCGATCTAAGAGGG
    2 P2-F AGCCCTCTTAGATCGCACAA 60 1253
    P2-R GTGACACCGAGCACAAAATG
    3 P3-F GTTGGAGCTGGATGAGCACT 60 1132
    P3-R TGAGGGAATTCCTGTCACCT
    下载: 导出CSV 
    | 显示表格

    采用Trizol法提取tva c.3G>A突变位点野生型tva c.3G/G和纯合突变型tva c.3A/A种鸡血液的总RNA,参考反转录试剂盒说明书反转录成cDNA。参考文献[18]中的引物序列和PCR反应体系、扩增条件,利用KOD-FX高保真酶RT-PCR扩增tva基因整个编码序列。回收、纯化的RT-PCR产物克隆入pMD19-T,送生工生物工程(上海)股份有限公司测序,测序结果应用Lasergene 7.1软件进行分析。

    采集10日龄鸡胚消毒后,用镊子打开气室和壳膜,夹起鸡胚,用眼科剪刀和镊子剔除头、爪、骨头和内脏,把鸡胚组织块置于平皿中,用PBS液漂洗去除血污。将漂洗好的组织块放入5 mL离心管,用眼科剪刀剪至肉糜状,用0.25%(w)的胰酶在37 ℃水浴箱中消化15~20 min,加入适量的小牛血清终止消化。使用200目细胞滤膜过滤后,1000 r/min离心5 min,弃掉上清液,用完全培养基对细胞进行重悬,分装入无菌培养皿中,获取纯化的鸡胚成纤维细胞 (Chicken embryo fibroblast,CEF),细胞置于CO2体积分数为5%、37 ℃的培养箱内培养。

    将重组质粒RCASBP(A)-EGFP转染入DF-1细胞中,转染后第7天,拯救并收集DF-1细胞上清液中表达绿色荧光蛋白的重组病毒RCASBP(A)-GFP,测定病毒感染单位(IU)后,分装保存于−80 ℃备用。分离与培养tva c.3G>A突变位点野生型tva c.3G/G、杂合突变型tva c.3G/A和纯合突变型tva c.3A/A CEF,分别接种于24孔板中,每孔接种5×104个细胞,培养24 h后,每孔接种5×105 IU/mL的RCASBP(A)-GFP病毒液。孵育2 h后,弃掉病毒液,用含1%(φ) 胎牛血清的维持液继续培养。感染后第1、2、3、7天,使用 Cytomics FC 500 分析仪(Beckman Coulter,USA)通过荧光激活细胞分选(Fluorescence-activated cell sorting,FACS)定量 tva c.3G>A突变位点不同基因型CEF的GFP 阳性细胞百分比。

    前期研究发现tva c.3G>A突变主要存在于CB06品系。从CB06品系随机挑选75只1日龄雏鸡随机分为3组,每组25只商品鸡和3只SPF鸡作为对照,饲养于3个隔离器,并随意提供饲料和水。1日龄时,每只雏鸡腹腔接种ALV-A GD08株病毒液(S/P=2.1)0.2 mL,5日龄时,再攻毒1次。攻毒后1周,采集每只雏鸡抗凝血样,抽取全基因组DNA,通过直接测序方法对每只雏鸡tva c.3G>A突变位点进行基因分型。攻毒后1个月,采集雏鸡的血样,利用Trizol试剂盒抽提血样总RNA,利用ALV-A GD08株特异性检测引物,RT-PCR检测每只雏鸡的病毒血症情况,确定tva c.3G>A突变不同基因型雏鸡对ALV-A GD08株的感染状态[18]

    所有数据均使用GraphPad Prism 7.0软件进行绘图和数据统计分析,2组数据比较采用独立样本t检验分析,数据结果以平均值±标准差表示。利用Popgene软件分析tva c.3G>A突变位点在我国黄羽肉鸡品系中的基因型频率分布。

    为了剖析中国黄羽肉鸡品系tva受体基因的遗传变异,分3个片段PCR扩增每只鸡tva受体基因的基因组区域。如图1所示,PCR扩增出tva基因的1、2和3片段的目的条带,片段大小与预期结果相符。将PCR产物进行Sanger测序,发现中国黄羽肉鸡品系tva基因DNA序列第260位碱基存在由G突变为A的自然突变(图2),进一步分析推测该突变致使tva基因编码区第3位碱基由G突变为A,引起tva基因起始密码子序列由ATG突变为ATA,将该tva基因自然突变命名为tva c.3G>A。为了证实纯合突变型tva c.3A/A转录本存在G>A突变,RT-PCR扩增野生型tva c.3G/G和纯合突变型tva c.3A/A血液tva基因整个编码序列。结果如图3所示,tva c.3G/G和tva c.3A/A基因型血样均扩增出566和420 bp的条带,表明tva c.3G>A突变位点在不同基因型血样均可扩增出tva基因长、短2个转录本。RT-PCR产物的克隆测序结果表明,与野生型tva c.3G/G相比,纯合突变型tva c.3A/A基因型2个tva cDNA序列第3位碱基均由G突变为A,引起Tva受体蛋白氨基酸序列第1个氨基酸由甲硫氨酸(M)改变为异亮氨酸(I)。

    图  1  tva基因3个片段的PCR扩增结果
    M:DL2000 marker;1~3:tva基因的1、2和3片段
    Figure  1.  PCR amplified results of three fragments of tva gene
    M: DL2000 marker; 1−3: Fragment 1, 2 and 3 of tva gene
    图  2  tva c.3G>A突变位点不同基因型测序图
    红色加粗标注为tva基因DNA序列第260位碱基由G突变为A
    Figure  2.  Sequence traces for tva c.3G>A mutation sites of different genotypes
    The positions of the mutates from G to A at 260th base of tva gene are underlined in red bold
    图  3  tva c.3G>A突变位点不同基因型血样全长tva编码序列的RT-PCR扩增结果
    M:DL2000 marker;1:野生型tva c.3G/G;2:纯合突变型tva c.3A/A
    Figure  3.  RT-PCR amplified results of the full-lengthtva coding sequences for blood samples from different genotypes of tva c.3G>A mutation site
    M: DL2000 marker; 1: Wild type tva c.3G/G; 2: Homozygous mutant tva c.3A/A

    RCASBP(A)-EGFP重组质粒转染DF-1细胞48 h后,用倒置荧光显微镜观察到GFP荧光标记蛋白表达,表明成功拯救了RCASBP(A)-GFP荧光报告病毒(图4)。为探究tva c.3G>A突变对宿主细胞体外感染ALV-A的影响,利用拯救的RCASBP(A)-GFP荧光报告病毒分别感染tva c.3G/G、tva c.3G/A和tva c.3A/A CEF,感染后不同时间点利用流式细胞术检测RCASBP(A)-GFP对tva c.3G>A突变位点不同基因型CEF的感染情况,结果如图56所示。野生型tva c.3G/G CEF和杂合突变型tva c.3G/A CEF对RCASBP(A)-GFP病毒易感,而纯合突变型tva c.3A/A CEF抗RCASBP(A)-GFP的感染,表明tva c.3G>A突变导致宿主体外抗RCASBP(A)-GFP的感染。

    图  4  RCASBP(A)-EGFP质粒转染DF-1细胞48 h后的绿色荧光蛋白表达
    绿色荧光为表达 GFP 的细胞;标尺=250 μm
    Figure  4.  Expression of green fluorescent protein in DF-1 cells after transfection with RCASBP(A)-EGFP plasmid for 48 h
    Green fluorescence represent cells expressing GFP; Scale =250 μm
    图  5  tva c.3G/G、tva c.3G/A和tva c.3A/A CEF感染RCASBP(A)-EGFP的过程
    Figure  5.  Time course of infection of tva c.3G/G, tva c.3G/A and tva c.3A/A CEFs with RCASBP(A)-EGFP
    图  6  流式细胞术检测tva c.3G>A突变位点不同基因型CEF感染RCASBP(A)-GFP 7 d后的GFP阳性细胞率
    Figure  6.  GFP positive cell rates for CEFs of different genotypes of tva c.3G>A mutation site seven days after infection with RCASBP(A)-GFP detected by flow cytometry

    为探究tva c.3G>A突变对宿主体内感染ALV-A的影响,利用ALV-A野毒感染tva c.3G>A突变野生型、杂合突变型、纯合突变型雏鸡。作为阳性对照,9只SPF雏鸡攻ALV-A野毒后均为ALV-A阳性,说明ALV-A体内攻毒试验成立。ALV-A攻毒试验结果显示,野生型tva c.3G/G雏鸡(25只)攻ALV-A野毒后均为ALV-A阳性,杂合突变型tva c.3G/A雏鸡(28只)攻ALV-A野毒后病毒血症阳性率为75%,而纯合突变型tva c.3A/A雏鸡(22只)攻ALV-A野毒后均为ALV-A阴性(表2)。结果表明,tva c.3G>A突变导致宿主体内抗ALV-A的感染,ALV-A体内攻毒试验结果与ALV-A体外感染试验结果一致,证实tva c.3G>A突变位点为ALV-A的遗传抗性位点。

    表  2  ALV-A攻毒后雏鸡病毒血症阳性率
    Table  2.  Positive infection rate of viremia in chicks infected by ALV-A
    雏鸡 Chick 基因型 Genotype 阳性样品数/总样品数 No. of positive samples/Total No. of samples 阳性感染率/% Positive infection rate
    SPF tva c.3G/G 9/9 100
    CB06 tva c.3G/G 25/25 100
    tva c.3G/A 21/28 75
    tva c.3A/A 0/22 0
    下载: 导出CSV 
    | 显示表格

    不同黄羽肉鸡品系tva c.3G>A抗性位点的基因分型结果如表3所示。CB01、CB08、CB10和CB15品系中检测到tva c.3G>A抗性位点的杂合基因型tva c.3G/A,其频率分别为0.05、0.05、0.10和0.14,在CB01、CB08、CB10和CB15品系中检测到纯合抗性基因型tva c.3A/A,其频率分别为0.10、0.15、0.23和0.08,其余黄羽肉鸡品系所检样品均为野生型tva c.3G/G。

    表  3  我国黄羽肉鸡品系 tva c.3G>A抗性位点的基因型频率分布
    Table  3.  Genotypic frequency of tva c.3G>A resistance locus in Chinese yellow-feathered broiler lines
    品系 Line 样品数/只 No. of samples 基因型 Genotype
    tva c.3G/G tva c.3G/A tva c.3A/A
    CB01 60 0.85 0.05 0.10
    CB02 50 1 0 0
    CB03 36 1 0 0
    CB04 30 1 0 0
    CB05 48 1 0 0
    CB06 60 1 0 0
    CB07 30 1 0 0
    CB08 60 0.80 0.05 0.15
    CB09 30 1 0 0
    CB10 60 0.67 0.10 0.23
    CB11 35 1 0 0
    CB12 45 1 0 0
    CB13 60 1 0 0
    CB14 30 1 0 0
    CB15 36 0.78 0.14 0.08
    下载: 导出CSV 
    | 显示表格

    本研究鉴定了中国黄羽肉鸡品系tva受体基因中存在1种自然突变位点,即tva基因编码区第3位碱基由G突变为A,引起tva基因起始密码子序列由ATG突变为ATA,致使宿主对ALV-A体外、体内的感染产生遗传抗性,证实tva c.3G>A突变位点为ALV-A的遗传抗性位点。据我们所知,本研究首次报道了受体基因起始密码子序列突变可以引起宿主遗传性抗特定ALV亚群的感染,这增强了我们对ALV-A宿主共同进化的理解。

    尽管种鸡群净化策略和生物安全措施已用来控制禽白血病[20],但这些传统方法并不能完全消除禽白血病在中国和东南亚国家的发生与流行[21-22]。ALV在鸡群中的流行,致使暴露于ALV的宿主可能会受到选择性压力而对ALV的感染产生完全抗性或者至少降低了对 ALV 感染的易感性。tvatvbtvcchNEH1受体基因分别编码Tva、Tvb、Tvc和NHE1受体蛋白,分别介导宿主细胞对ALV-A、ALV-B/D/E、ALV-C和ALV-J的感染[14, 23-25]。受体基因的遗传突变会导致受体蛋白的完全缺失或表达一个缺陷型受体蛋白,从而引起宿主对ALV的感染产生遗传抗性。目前,已在国外某些白来航近交品系和中国肉鸡品系中鉴定了致使宿主细胞对ALV-A、ALV-B/D/E和ALV-C感染产生遗传抗性的受体基因遗传突变[16, 24,26]。Elleder等[16]在白来航品系C中发现tva基因第619碱基由C变为G(tvar1),引起编码的氨基酸由Cys改变为Trp,大大降低ALV-A囊膜糖蛋白与Tva受体的亲和力,从而对ALV-A的感染产生遗传抗性。Elleder等[16]在白来航品系72中发现tva基因碱基序列第305—306位点插入CTCG 4个碱基(tvar2),导致Tva受体蛋白缺失表达,从而产生对ALV-A的抗性。Chen等[18]研究发现中国鸡种存在tvar3tvar4tvar5tvar6 ALV-A遗传抗性位点,其为位于tva受体基因内含子1破裂点信号保守区域的4种缺失突变,tvar3tva基因第507—516碱基(序列为ACCCCGCCCC)缺失、tvar4tva基因第507—511碱基(序列为ACCCC)缺失、tvar5tva基因第502—511碱基(序列为CGCTCACCCC)缺失、tvar6tva基因第502—516碱基(序列为CGCTCACCCCGCCCC)缺失,这4种tva受体基因遗传突变均影响tva基因mRNA的剪切,降低了ALV-A囊膜糖蛋白与Tva受体蛋白结合的亲和力,从而降低宿主细胞对ALV-A的易感性。本研究在我国黄羽肉鸡品系中发现tva受体基因始密码子序列由ATG突变为ATA,引起Tva受体蛋白氨基酸序列第1个氨基酸由甲硫氨酸(M)改变为异亮氨酸(I),推测该突变导致Tva受体蛋白的表达完全缺失,从而引起宿主抗ALV-A的感染。

    抗病育种是控制禽白血病的有效策略和重要途径,为评估不同黄羽肉鸡品系对ALV-A的遗传抗性,本研究对15个黄羽肉鸡品系tva c.3G>A抗性位点进行了基因分型,结果发现CB01、CB08、CB10和CB15品系存在tva c.3G>A抗性位点,其纯合抗性基因型tva c.3A/A的频率分别为0.10、0.15、0.23和0.08,提示这些黄羽肉鸡品系具有良好的抗 ALV-A 遗传改良潜力,可从这些鸡品系中筛选出培育抗ALV-A感染的育种素材,并运用于ALV-A 遗传抗性鸡品种的选育,为实现A亚群禽白血病抗病育种提供理论依据和技术支撑。

  • 图  1   果园机器人导航技术框架

    Figure  1.   Framework of orchard robot navigation technology

    图  2   果园机器人换行策略

    dts:换行后直线行驶距离;Rt:转弯半径;v:线速度;$ \omega $:角速度

    Figure  2.   Line breaking strategy of orchard robot

    dts: Straight line driving distance after line break; Rt: Turning radius; v: Linear velocity; $ \omega $: Angular velocity

    图  3   运动模型

    v:线速度;vr:右侧轮速度;vl:左侧轮速度;$ \omega $:角速度;$ \theta $:姿态角;£:轮距;p:机器人中心位置;LlLr:左、右两侧果树行

    Figure  3.   Motion model

    v: Linear velocity; vr: Right wheels speed; vl: Left wheels speed; ω: Angular velocity; θ : Attitude angle; £: Wheelspan; p: Center position of robot; Ll, Lr: Fruit tree rows on the left and right sides

    图  4   果园机器人轨迹跟踪示意图

    K:目标轨迹;B:目标点;$ \alpha $:航向偏差;f:前视距离;d:横向偏差;A:圆弧轨迹对应的圆心;R:轨迹半径;COC边上的垂足;O:机器人中心位置

    Figure  4.   Orchard robot trajectory tracking diagram

    K: Target trajectory; B: Target point; $ \alpha $: Course deviation; f: Forward-looking distance; d: Lateral deviation; A: Center of the arc trajectory; R: Trajectory radius; C: Vertical foot at the edge of OC; O: Robot center position

    图  5   不同前视距离(f )下路径跟踪仿真结果

    红色圆点表示目标轨迹点,绿色圆点表示轨迹终点,蓝色曲线表示实际轨迹

    Figure  5.   Path tracking results at different forward-viewing distances(f)

    The red dots represent the target track points, the green dots represent the end of the track, and the blue curve represents the actual track

    图  6   果园机器人基本组成

    Figure  6.   Basic composition of orchard robot

    图  7   点云预处理

    a:果园真实环境;b:原始点云;c:分割地面后的点云,其中,白色部分为地面点云,红色部分为非地面点云,即果树行点云

    Figure  7.   Point cloud pretreatment

    a: Real environment of the orchard; b: Original point cloud; c: Point cloud after ground segmentation. In c, the white part is ground point cloud, and the red part is non-ground point cloud, namely, fruit tree row point cloud

    图  8   拟合导航线

    a:去除地面后的点云;b:聚类后的点云;c:生成导航线后的点云;d:存在离散果树的点云;c、d中,绿色直线为拟合得到的果树行直线,红色直线为推算得到的导航线

    Figure  8.   Fitting navigation lines

    a: Point cloud after ground removal; b: Point cloud after clustering; c: Point cloud with the navigation line; d: Point clouds with discrete fruit trees. In c and d, the green line is the fruit tree line obtained by fitting, and the red line is the navigation line obtained by calculation

    表  1   速度0.8 m/s下3种算法产生的偏差结果

    Table  1   The deviation results generated by the three algorithms under the speed of 0.8 m/s

    算法
    Algorithm
    横向偏差/m
    Lateral deviation
    平均横向偏差/m
    Mean lateral deviation
    航向偏差/(°)
    Course deviation
    平均航向偏差/(°)
    Mean course deviation
    LSM算法
    LSM algorithm
    0.20
    0.18
    0.23
    0.21
    0.19
    0.202 2.1
    1.8
    2.2
    1.7
    2.0
    1.96
    传统RANSAC算法
    Traditional RANSAC algorithm
    0.16
    0.15
    0.13
    0.18
    0.17
    0.158 1.3
    1.8
    1.5
    1.2
    1.8
    1.52
    改进RANSAC算法
    Improved RANSAC algorithm
    0.08
    0.10
    0.09
    0.07
    0.08
    0.084 1.5
    1.5
    1.2
    1.3
    1.2
    1.34
    下载: 导出CSV

    表  2   速度1.0 m/s下3种算法产生的偏差结果

    Table  2   The deviation results generated by the three algorithms under the speed of 1.0 m/s

    算法
    Algorithm
    横向偏差/m
    Lateral deviation
    平均横向偏差/m
    Mean lateral deviation
    航向偏差/(°)
    Course deviation
    平均航向偏差/(°)
    Mean course deviation
    LSM算法
    LSM algorithm
    0.25
    0.28
    0.26
    0.23
    0.24
    0.252 2.3
    2.5
    2.6
    2.4
    2.7
    2.50
    传统RANSAC算法
    Traditional RANSAC algorithm
    0.23
    0.22
    0.24
    0.22
    0.21
    0.224 2.2
    2.4
    1.9
    2.5
    2.6
    2.32
    改进RANSAC算法
    Improved RANSAC algorithm
    0.14
    0.09
    0.08
    0.13
    0.10
    0.108 2.0
    1.8
    2.1
    2.2
    2.0
    2.02
    下载: 导出CSV
  • [1] 王祺, 王艳玲, 俄胜哲. 我国果园机械装备现状及发展思路[J]. 农业机械, 2019(1): 109-111.
    [2]

    LAN Y B, CHEN S D. Current status and trends of plant protection UAV and its spraying technology in China[J]. International Journal of Precision Agricultural Aviation, 2018, 1(1): 1-9.

    [3]

    GONG J L, WANG M X, ZHANG Y F, et al. Flow and sound field analysis of agricultural ultrasonic atomizing nozzle[J]. International Journal of Precision Agricultural Aviation, 2019, 2(2): 32-37.

    [4] 秦喜田, 刘学峰, 任冬梅, 等. 我国果园生产机械化现状及其发展趋势[J]. 农业装备与车辆工程, 2019, 57(S1): 35-38.
    [5] 张漫, 季宇寒, 李世超, 等. 农业机械导航技术研究进展[J]. 农业机械学报, 2020, 51(4): 1-18. doi: 10.6041/j.issn.1000-1298.2020.04.001
    [6] 陈媛媛, 游炯, 幸泽峰, 等. 世界主要国家精准农业发展概况及对中国的发展建议[J]. 农业工程学报, 2021, 37(11): 315-324. doi: 10.11975/j.issn.1002-6819.2021.11.036
    [7] 刘成良, 林洪振, 李彦明, 等. 农业装备智能控制技术研究现状与发展趋势分析[J]. 农业机械学报, 2020, 51(1): 1-18. doi: 10.6041/j.issn.1000-1298.2020.01.001
    [8] 何勇, 蒋浩, 方慧, 等. 车辆智能障碍物检测方法及其农业应用研究进展[J]. 农业工程学报, 2018, 34(9): 21-32. doi: 10.11975/j.issn.1002-6819.2018.09.003
    [9] 李道亮, 李震. 无人农场系统分析与发展展望[J]. 农业机械学报, 2020, 51(7): 1-12. doi: 10.6041/j.issn.1000-1298.2020.07.001
    [10] 周建军, 周文彬, 刘建东, 等. 果园机器人自动导航技术研究进展[J]. 计算机与数字工程, 2019, 47(3): 571-576.
    [11] 李秋洁, 丁旭东, 邓贤. 基于激光雷达的果园行间路径提取与导航[J]. 农业机械学报, 2020, 51(S2): 344-350. doi: 10.6041/j.issn.1000-1298.2020.S2.040
    [12] 莫冬炎, 杨尘宇, 黄沛琛, 等. 基于环境感知的果园机器人自主导航技术研究进展[J]. 机电工程技术, 2021, 50(9): 145-150. doi: 10.3969/j.issn.1009-9492.2021.09.038
    [13]

    BLOK P M, SUH H K, VAN BOHEEMEN K, et al. Autonomous in-row navigation of an orchard robot with a 2D LIDAR scanner and particle filter with a laser-beam model[J]. Journal of Institute of Control, Robotics and Systems, 2018, 24(8): 726-735. doi: 10.5302/J.ICROS.2018.0078

    [14] 姬长英, 周俊. 农业机械导航技术发展分析[J]. 农业机械学报, 2014, 45(9): 44-54. doi: 10.6041/j.issn.1000-1298.2014.09.008
    [15] 赛炜, 孙忠涵. 基于激光雷达的机器人智能导航系统研究[J]. 激光杂志, 2019, 40(11): 182-186.
    [16]

    ZHANG H F, HONG Y, QIU J L. An off-policy least square algorithms with eligibility trace based on importance reweighting[J]. Cluster Computing, 2017, 20(4): 3475-3487. doi: 10.1007/s10586-017-1165-0

    [17]

    FOTOUHI M, HEKMATIAN H, KASHANI-NEZHAD M A, et al. SC-RANSAC: Spatial consistency on RANSAC[J]. Multimedia Tools and Applications, 2019, 78(7): 9429-9461. doi: 10.1007/s11042-018-6475-6

    [18]

    SANGAPPA H K, RAMAKRISHNAN K R. A probabilistic analysis of a common RANSAC heuristic[J]. Machine Vision and Applications, 2019, 30(1): 71-89. doi: 10.1007/s00138-018-0973-4

    [19] 张华强, 王国栋, 吕云飞, 等. 基于改进纯追踪模型的农机路径跟踪算法研究[J]. 农业机械学报, 2020, 51(9): 18-25. doi: 10.6041/j.issn.1000-1298.2020.09.002
  • 期刊类型引用(1)

    1. 李艳芬,马瑞峻,陈瑜,黄丽,颜振锋,蔡祥. 光谱技术结合化学计量学分析方法快速检测阿维菌素的试验研究. 农业环境科学学报. 2023(09): 2140-2146 . 百度学术

    其他类型引用(0)

图(8)  /  表(2)
计量
  • 文章访问数:  1221
  • HTML全文浏览量:  7
  • PDF下载量:  420
  • 被引次数: 1
出版历程
  • 收稿日期:  2021-11-20
  • 网络出版日期:  2023-05-17
  • 刊出日期:  2022-09-09

目录

/

返回文章
返回