CN112556681A - 一种基于视觉的果园机械导航定位方法 - Google Patents
一种基于视觉的果园机械导航定位方法 Download PDFInfo
- Publication number
- CN112556681A CN112556681A CN201910854692.9A CN201910854692A CN112556681A CN 112556681 A CN112556681 A CN 112556681A CN 201910854692 A CN201910854692 A CN 201910854692A CN 112556681 A CN112556681 A CN 112556681A
- Authority
- CN
- China
- Prior art keywords
- orchard
- navigation
- fruit tree
- machine
- orchard machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
- G06K7/00—Methods or arrangements for sensing record carriers, e.g. for reading patterns
- G06K7/10—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation
- G06K7/14—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation using light without selection of wavelength, e.g. sensing reflected white light
- G06K7/1404—Methods for optical code recognition
- G06K7/1408—Methods for optical code recognition the method being specifically adapted for the type of code
- G06K7/1417—2D bar codes
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
Abstract
一种基于视觉的果园机械导航定位方法,包括如下步骤:系统初始化后判断果园机械是否接收到卫星导航信号,若卫星导航信号正常则直接使用卫星导航;若卫星导航信号丢失则采用如下视觉导航定位;所述果园机械通过深度摄像头采集贴于对应的果树树干上的果树二维码信息得到视野内每颗果树的位置坐标(xn,yn);所述果园机械在果树行间行驶并通过深度摄像头采集到的图像和深度信息,采用视觉里程计实时推算所述果园机械相对于运动起始点的位姿,并推算该果园机械的相对位置;以及通过所述深度摄像头采集果树树干的三维轮廓和对应的所述果树二维码的信息,返回所述果树的树干位置和世界坐标,推算所述果园机械的绝对位置,并校正所述视觉里程计的累积误差。
Description
技术领域
本发明涉及农业机器人的定位方法,特别是一种基于视觉的果园机械导航定位方法。
背景技术
精准导航是智能化果园机械装备的关键技术,稳定的导航能力才能够保证果园机械自动行驶到果园的各个角落。导航定位方法的研究作为精准导航的基础工作,其性能的好坏直接影响着果园机械导航作业的控制精度。
果园机械自主作业时,需要在两行果树之间行驶,传统的卫星定位由于果树浓密树冠的遮挡,信号时有时无易导致定位效果不佳,进而影响作业精度。
发明内容
本发明所要解决的技术问题是针对现有技术的上述问题,提供一种基于视觉的果园机械导航定位方法。
为了实现上述目的,本发明提供了一种基于视觉的果园机械导航定位方法,其中,包括如下步骤:
S100、系统初始化后判断果园机械是否接收到卫星导航信号,若卫星导航信号正常则直接使用卫星导航;若卫星导航信号丢失则采用如下视觉导航定位;
S200、所述果园机械通过深度摄像头采集果树二维码的信息得到视野内每颗果树的位置坐标(Xn,Yn),所述果树二维码为预先生成的果树位置坐标信息并贴于对应的果树树干上;
S300、所述果园机械在果树行间行驶并通过深度摄像头采集到的图像和深度信息,采用视觉里程计实时推算所述果园机械相对于运动起始点的位姿,并推算该果园机械的相对位置;以及
S400、通过所述深度摄像头采集果树树干的三维轮廓和对应的所述果树二维码的信息,返回所述果树的树干位置和世界坐标,推算所述果园机械的绝对位置,并校正所述视觉里程计的累积误差。
上述的基于视觉的果园机械导航定位方法,其中,步骤S400中,所述深度摄像头通过图像处理的方法识别所述果树的树干位置,所述深度摄像头生成所述果园机械的前方三维地图,并计算所述树干位置的中心与所述果园机械之间的相对距离dn。
上述的基于视觉的果园机械导航定位方法,其中,参照至少两组所述相对距离的信息和位置坐标推算所述果园机械的绝对位置,并校正所述视觉里程计累积误差。
上述的基于视觉的果园机械导航定位方法,其中,所述果园机械的绝对位置(X0,Y0)通过如下方程联立求解推算:
其中,x1,x2,……,xn,y1,y2,……,yn为视野内1-n棵果树对应的位置坐标,d1,d2,……,dn分别为1-n棵果树的树干位置中心与所述果园机械之间的相对距离。
上述的基于视觉的果园机械导航定位方法,其中,步骤S300中,所述视觉里程计基于特征点匹配或像素灰度值差异,利用所述三维轮廓与所述深度摄像头采集到的图像的对应关系,求解相邻帧所述图像的所述深度摄像头的位姿。
上述的基于视觉的果园机械导航定位方法,其中,采用拓展卡尔曼滤波器或非线性优化方法求解相邻帧所述图像的所述深度摄像头的位姿。
上述的基于视觉的果园机械导航定位方法,其中,所述步骤S300中,所述果园机械将所述果树的世界坐标位置作为初始位置,以实现准确的定位导航。
上述的基于视觉的果园机械导航定位方法,其中,所述卫星导航信号丢失后,所述深度摄像头实时采集所述果园环境中果树的图像信息和深度信息,生成所述果园机械的前方三维环境图,同时根据相邻的所述前方三维环境图的图像信息估计所述深度摄像头的运动,通过所述视觉里程计得到所述果园机械相对所述初始位置的位姿并推算所述果园机械的相对位置。
上述的基于视觉的果园机械导航定位方法,其中,所述视觉里程计每一间隔时间进行一次绝对位置校正,以防止所述视觉里程计的累积误差造成位置偏移影响定位精度。
上述的基于视觉的果园机械导航定位方法,其中,还包括:
S500、判断卫星导航信号是否恢复,若卫星导航信号正常,则恢复使用卫星导航,并将最近一次所述果园机械的绝对位置校正作为初始点,卫星定位信息作为当前点进行所述视觉里程计的累积误差校正,以保证导航路径的连续性和准确性。
本发明的技术效果在于:
本发明在果树行间利用深度摄像头和二维码信息获取定位信息和位姿估计,通过距离信息和定位信息得到果园机械绝对位置,不需构建字典回环检测便可校正视觉里程计累积误差,运算量小,实时性好;实现了果园机械的精准定位,降低了硬件的复杂性和成本投入,弥补了卫星定位系统在浓密树冠遮挡下定位不可靠的问题,可以让果园机械在丢失卫星信号的时候实现定位导航,满足了果园机械在果园环境中连续工作需求。
以下结合附图和具体实施例对本发明进行详细描述,但不作为对本发明的限定。
附图说明
图1为本发明一实施例的导航定位方法流程图;
图2为本发明一实施例的导航定位方法原理图;
图3为本发明一实施例的计算果园机械绝对位置原理图。
其中,附图标记
1 果园机械
2 卫星定位模块
3 深度摄像头
4 果树
5 导航路径
具体实施方式
下面结合附图对本发明的结构原理和工作原理作具体的描述:
参见图1,图1为本发明一实施例的导航定位方法流程图。本发明基于视觉的果园机械导航定位方法,在卫星信号丢失的情况下启用视觉导航定位,在信号正常的情况下直接使用卫星导航,视觉导航定位包括如下步骤:
步骤S100、系统初始化后判断果园机械1是否接收到卫星导航信号,若卫星导航信号正常则直接使用卫星导航;若卫星导航信号丢失则采用如下视觉导航定位;
步骤S200、所述果园机械1通过深度摄像头3采集果树二维码的信息得到视野内每颗果树4的位置坐标(Xn,Yn),所述果树二维码为预先生成的果树4位置坐标信息并贴于对应的果树4树干上,即在导航定位开始之前,将果树4的卫星(GPS/北斗)位置坐标信息、经纬度信息生成二维码提前贴于对应果树4的树干,以便导航的时候深度摄像头3实时采集;
步骤S300、所述果园机械1在果树4行间行驶并通过深度摄像头3采集到的图像和深度信息,采用视觉里程计实时推算所述果园机械1相对于运动起始点的位姿,并推算该果园机械1的相对位置;以及
步骤S400、通过所述深度摄像头3采集果树4的树干三维轮廓和对应的所述果树二维码的信息,返回所述果树4的树干位置和世界坐标,推算所述果园机械1的绝对位置,并校正所述视觉里程计的累积误差。
本实施例还可包括:
步骤S500、判断卫星导航信号是否恢复,若卫星导航信号正常,则恢复使用卫星导航,并将最近一次所述果园机械1的绝对位置校正作为初始点,卫星定位信息作为当前点进行所述视觉里程计的累积误差校正,以保证导航路径5的连续性和准确性。
其中,步骤S400中,所述深度摄像头3通过图像处理的方法识别所述果树4的树干位置,所述深度摄像头3生成所述果园机械1的前方三维地图,并计算所述树干位置的中心与所述果园机械1之间的相对距离dn。可参照至少两组所述相对距离的信息和位置坐标推算所述果园机械1的绝对位置,并校正所述视觉里程计累积误差。其中,所述果园机械1的绝对位置(X0,Y0)通过如下方程联立求解推算:
其中,X1,X2,……,Xn,Y1,Y2,……,Yn为视野内1-n棵果树4对应的位置坐标,d1,d2,……,dn分别为1-n棵果树4的树干位置中心与所述果园机械1之间的相对距离。
在步骤S300中,所述视觉里程计基于特征点匹配或像素灰度值差异,利用所述三维轮廓与所述深度摄像头3采集到的图像的对应关系,求解相邻帧所述图像的所述深度摄像头3的位姿。采用拓展卡尔曼滤波器或非线性优化方法求解相邻帧所述图像的所述深度摄像头3的位姿。且所述果园机械1将所述果树4的世界坐标位置作为初始位置,以实现准确的定位导航。
当所述卫星导航信号丢失后,所述深度摄像头3实时采集所述果园环境中果树4的图像信息和深度信息,生成所述果园机械1的前方三维环境图,同时根据相邻的所述前方三维环境图的图像信息估计所述深度摄像头3的运动,通过所述视觉里程计得到所述果园机械1相对所述初始位置的位姿并推算所述果园机械1的相对位置。所述视觉里程计每一间隔时间进行一次绝对位置校正,以防止所述视觉里程计的累积误差造成位置偏移影响定位精度。
参见图2,图2为本发明一实施例的导航定位方法原理图。如图所示,当果园机械1在果树4行间沿导航路径5行驶时,通过深度摄像头3采集到的图像和深度信息,采用视觉里程计实时推算当前果园机械1相对于运动起始点的位姿估计,推算果园机械1相对位置。预先将果园环境中果树4的位置坐标信息生成二维码贴于果树4树干,通过深度摄像头3采集树干三维轮廓和二维码信息,返回树干距离和果树4世界坐标,推算果园机械1绝对位置,校正视觉里程计累积误差。
在本发明一实施例中,果园机械导航定位方法的具体工作过程如下:
系统初始化后判断卫星信号是否丢失,如果信号丢失,将此时的世界坐标位置作为初始位置,深度摄像头3获取图像数据;
所述深度摄像头3可以实时采集图像信息和深度图,生成果园机械1前方三维环境,通过视觉里程计得到果园机械1相对初始位置的位姿估计,推算相对位置;其中,所述深度摄像头3获取图像数据,通过图像处理的方法识别果树4树干位置,结合深度图确定果园机械1与果树4中心点的距离。将果树4的位置坐标信息生成二维码贴于果树4的树干,深度摄像头3采集二维码信息得到果树4的位置坐标。参照几组(至少2组)果树4距离信息和位置坐标推算果园机械1绝对位置,校正视觉里程计累积误差。绝对位置校正每过一段时间进行一次,防止位姿估计累积误差过大。当卫星信号恢复时,将最后一次绝对位置校正作为初始点,卫星定位信息作为当前点进行一次视觉里程计校正,进而保证导航路径5的连续性和准确性。
其中,所述视觉里程计是移动机器人系统的一种自我定位方法,按照是否需要提取特征,可分为特征点法和直接法。视觉里程计工作时,基于特征点匹配或像素灰度值差异,利用已知三维结构与图像的对应关系,求解相邻帧图像的摄像机位姿估计,求解方法较多,本实施例优选通过拓展卡尔曼滤波器和非线性优化两大类方法来解决。
求解过程可总结为两个基本方程:
假设果园机械1正携带某种传感器和相机在未知环境里运动,因为相机通常是在某些时刻采集数据,所以就把导航时一段连续时间的运动看成离散时刻t=1,……,k当中发生的事情。在这些时刻,用x表示果园机械1自身的位置,于是各时刻的位置就记为x1,……,xk,它们构成了果园机械1运动过程的轨迹。假设地图由多个路标组成,而每一个时刻,传感器会测量得到一部分路标点,设路标点一共有n个,用y1,……,yn表示它们。
第一个方程xk=f(xk-1,uk,wk)为运动方程,通常果园机械1会携带一个测量自身运动的传感器,比如编码器或惯性传感器。这个传感器可以测量有关运动的读数,但不一定直接就是位置之差,还可能是加速度、角速度等信息。然而无论是什么传感器,都可使用一个通用的、抽象的数学模型来表示,即:
xk=f(xk-1,uk,wk)
公式中,uk是运动传感器的读数,wk为噪声。这里用一个一般函数f来描述这个过程,但不具体指明f的作用方式,因此整个函数可以指代任意的运动传感器,成为一个通用的方程。
第二个方程zk,j=h(yj,xk,vk,j)为观测方程,观测方程的描述是,当果园机械1在xk位置上看到某个路标点yj,产生了一个观测数据zk,j,vk,j是这次观测里的噪声,观测使用的传感器形式很多,如深度摄像头3、激光雷达等,同样用一个抽象函数h来描述这个关系。
zk,j=h(yj,xk,vk,j)
已知运动测量读数u,以及传感器读数z时,求解定位问题(估计x)和建图问题(估计y)。
其中,定位问题就是通过获取已知运动测量读数u以及传感器读数z,求解相邻图像间(视频每帧之间)果园机械1的相对运动,估算果园机械1相较于起始点的自身位置x(根据每两帧图像推算出的位置,记为x1,……,xk)。建图问题指果园机械1在k时刻与xk处探测到某一个路标yj,考虑如何用数学语言来描述yj的空间位置,也就是估计y。
注意,上述公式中涉及的x,y与果树二维码及果园机械1绝对位置中的X,Y含义不同,果树二维码中的X,Y是通过卫星定位获取的位置坐标信息,果园机械1绝对位置是基于果树二维码的位置坐标通过联立方程求算的果园机械1的绝对位置坐标,在此以大小写不同以示二者的区别。
参见图3,图3为本发明一实施例的计算果园机械绝对位置原理图,本发明的果园机械1的绝对位置计算原理如图3所示。运动测量读数uk可通过卫星定位模块2或编码器、IMU等传感器读取,编码器与电机轴连接,用于测量电机轴位置、角度、圈数等信息;卫星定位模块2或IMU安装于车架,尽量靠近机身重心,用于工作时测量机身三轴姿态角以及加速度。编码器和IMU仅用于举例,传感器类型不限于这两种,只要可测量机器自身运动的传感器均可。传感器读数zk,j可通过深度摄像头3、激光雷达等传感器读取,本实施例采用深度摄像头3采集zk,j,安装于果园机械1的顶部靠前位置。预先将果树4的位置坐标信息生成果树二维码贴于果树4树干,果园机械1可通过深度摄像头3采集二维码信息得到视野内每颗果树4的位置坐标(Xn,Yn)。通过图像处理的方法识别果树4的树干位置,深度摄像头3可生成果园机械1前方三维地图,进而可以计算到果树4中心与果园机械1的相对距离dn。
参照几组(至少2组)果树4距离信息和位置坐标,便可通过平面几何的方式推算出果园机械1绝对位置(X0,Y0),进而校正视觉里程计的累积误差。
求解过程可总结为一个基本方程:
可通过方程联立求解推算果园机械1绝对位置(X0,Y0)。
本发明可将果园机械在果园中的导航定位分为两部分:当果园机械在果树行间行驶时,通过深度摄像头采集到的图像和深度信息,采用视觉里程计实时推算当前果园机械相对于运动起始点的位姿估计;将果园环境中果树的位置坐标信息生成二维码贴于果树树干,通过深度摄像头采集树干三维轮廓和二维码信息,返回树干距离和果树世界坐标,推算果园机械绝对位置。既可以实时计算果园机械连续运动的相对位姿估计,也可以得到果园机械世界坐标,校正视觉里程计位姿累积误差,实现果园机械丢失卫星信号时的准确定位。可以让果园机械在丢失卫星信号时实现定位导航,克服由于果园浓密树冠对卫星信号的遮挡导致的定位导航效果不好的问题。
当然,本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,熟悉本领域的技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (10)
1.一种基于视觉的果园机械导航定位方法,其特征在于,包括如下步骤:
S100、系统初始化后判断果园机械是否接收到卫星导航信号,若卫星导航信号正常则直接使用卫星导航;若卫星导航信号丢失则采用如下视觉导航定位;
S200、所述果园机械通过深度摄像头采集果树二维码的信息得到视野内每颗果树的位置坐标(Xn,Yn),所述果树二维码为预先生成的果树位置坐标信息并贴于对应的果树树干上;
S300、所述果园机械在果树行间行驶并通过深度摄像头采集到的图像和深度信息,采用视觉里程计实时推算所述果园机械相对于运动起始点的位姿,并推算该果园机械的相对位置;以及
S400、通过所述深度摄像头采集果树树干的三维轮廓和对应的所述果树二维码的信息,返回所述果树的树干位置和世界坐标,推算所述果园机械的绝对位置,并校正所述视觉里程计的累积误差。
2.根据权利要求1所述的基于视觉的果园机械导航定位方法,其特征在于,步骤S400中,所述深度摄像头通过图像处理的方法识别所述果树的树干位置,所述深度摄像头生成所述果园机械的前方三维地图,并计算所述树干位置的中心与所述果园机械之间的相对距离dn。
3.根据权利要求2所述的基于视觉的果园机械导航定位方法,其特征在于,参照至少两组所述相对距离的信息和位置坐标推算所述果园机械的绝对位置,并校正所述视觉里程计累积误差。
5.根据权利要求1、2、3或4所述的基于视觉的果园机械导航定位方法,其特征在于,步骤S300中,所述视觉里程计基于特征点匹配或像素灰度值差异,利用所述三维轮廓与所述深度摄像头采集到的图像的对应关系,求解相邻帧所述图像的所述深度摄像头的位姿。
6.根据权利要求5所述的基于视觉的果园机械导航定位方法,其特征在于,采用拓展卡尔曼滤波器或非线性优化方法求解相邻帧所述图像的所述深度摄像头的位姿。
7.根据权利要求5所述的基于视觉的果园机械导航定位方法,其特征在于,所述步骤S300中,所述果园机械将所述果树的世界坐标位置作为初始位置,以实现准确的定位导航。
8.根据权利要求7所述的基于视觉的果园机械导航定位方法,其特征在于,所述卫星导航信号丢失后,所述深度摄像头实时采集所述果园环境中果树的图像信息和深度信息,生成所述果园机械的前方三维环境图,同时根据相邻的所述前方三维环境图的图像信息估计所述深度摄像头的运动,通过所述视觉里程计得到所述果园机械相对所述初始位置的位姿并推算所述果园机械的相对位置。
9.根据权利要求8所述的基于视觉的果园机械导航定位方法,其特征在于,所述视觉里程计每一间隔时间进行一次绝对位置校正,以防止所述视觉里程计的累积误差造成位置偏移影响定位精度。
10.根据权利要求7、8或9所述的基于视觉的果园机械导航定位方法,其特征在于,还包括:
S500、判断卫星导航信号是否恢复,若卫星导航信号正常,则恢复使用卫星导航,并将最近一次所述果园机械的绝对位置校正作为初始点,卫星定位信息作为当前点进行所述视觉里程计的累积误差校正,以保证导航路径的连续性和准确性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910854692.9A CN112556681B (zh) | 2019-09-10 | 2019-09-10 | 一种基于视觉的果园机械导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910854692.9A CN112556681B (zh) | 2019-09-10 | 2019-09-10 | 一种基于视觉的果园机械导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112556681A true CN112556681A (zh) | 2021-03-26 |
CN112556681B CN112556681B (zh) | 2023-04-28 |
Family
ID=75029016
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910854692.9A Active CN112556681B (zh) | 2019-09-10 | 2019-09-10 | 一种基于视觉的果园机械导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112556681B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116660916A (zh) * | 2023-05-26 | 2023-08-29 | 广东省农业科学院设施农业研究所 | 一种用于果园移动机器人的定位方法、建图方法及电子设备 |
WO2024022204A1 (zh) * | 2022-07-27 | 2024-02-01 | 格力博(江苏)股份有限公司 | 园林工具及其控制方法和系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102368158A (zh) * | 2011-09-15 | 2012-03-07 | 西北农林科技大学 | 一种果园机械导航定位方法 |
CN106017477A (zh) * | 2016-07-07 | 2016-10-12 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN205843680U (zh) * | 2016-07-07 | 2016-12-28 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN106323267A (zh) * | 2015-06-24 | 2017-01-11 | 南京农业大学 | 果园作业农业机器人行间定位方法 |
CN108180913A (zh) * | 2018-01-03 | 2018-06-19 | 深圳勇艺达机器人有限公司 | 一种基于3d摄像头的二维码定位系统 |
US20180297207A1 (en) * | 2017-04-14 | 2018-10-18 | TwoAntz, Inc. | Visual positioning and navigation device and method thereof |
-
2019
- 2019-09-10 CN CN201910854692.9A patent/CN112556681B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102368158A (zh) * | 2011-09-15 | 2012-03-07 | 西北农林科技大学 | 一种果园机械导航定位方法 |
CN106323267A (zh) * | 2015-06-24 | 2017-01-11 | 南京农业大学 | 果园作业农业机器人行间定位方法 |
CN106017477A (zh) * | 2016-07-07 | 2016-10-12 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN205843680U (zh) * | 2016-07-07 | 2016-12-28 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
US20180297207A1 (en) * | 2017-04-14 | 2018-10-18 | TwoAntz, Inc. | Visual positioning and navigation device and method thereof |
CN108180913A (zh) * | 2018-01-03 | 2018-06-19 | 深圳勇艺达机器人有限公司 | 一种基于3d摄像头的二维码定位系统 |
Non-Patent Citations (3)
Title |
---|
周俊等: "密植果园作业机器人行间定位方法", 《农业机械学报》 * |
王东等: "基于GNSS与视觉融合的山地果园无人机航迹控制", 《农业机械学报》 * |
王帅先: "基于农业机器人试验平台的郁闭型果园视觉导航系统研究", 《万方数据》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024022204A1 (zh) * | 2022-07-27 | 2024-02-01 | 格力博(江苏)股份有限公司 | 园林工具及其控制方法和系统 |
CN116660916A (zh) * | 2023-05-26 | 2023-08-29 | 广东省农业科学院设施农业研究所 | 一种用于果园移动机器人的定位方法、建图方法及电子设备 |
CN116660916B (zh) * | 2023-05-26 | 2024-02-02 | 广东省农业科学院设施农业研究所 | 一种用于果园移动机器人的定位方法、建图方法及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN112556681B (zh) | 2023-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111207774B (zh) | 一种用于激光-imu外参标定的方法及系统 | |
US11243081B2 (en) | Slam assisted INS | |
CN110044354A (zh) | 一种双目视觉室内定位与建图方法及装置 | |
CN106017463B (zh) | 一种基于定位传感装置的飞行器定位方法 | |
US10352959B2 (en) | Method and system for estimating a path of a mobile element or body | |
US11940277B2 (en) | Vision-aided inertial navigation system for ground vehicle localization | |
WO2022105024A1 (zh) | 机器人位姿的确定方法、装置、机器人及存储介质 | |
EP2503510B1 (en) | Wide baseline feature matching using collaborative navigation and digital terrain elevation data constraints | |
CN107909614B (zh) | 一种gps失效环境下巡检机器人定位方法 | |
Kneip et al. | Closed-form solution for absolute scale velocity determination combining inertial measurements and a single feature correspondence | |
KR20150088636A (ko) | 위치 추정 장치 및 방법 | |
WO2022193508A1 (zh) | 位姿优化方法、装置、电子设备、计算机可读存储介质、计算机程序及程序产品 | |
CN111380514A (zh) | 机器人位姿估计方法、装置、终端及计算机存储介质 | |
JP4171459B2 (ja) | 移動体の回転移動量利用方法とその装置、及びコンピュータプログラムを保存するコンピュータ読取り可能な記録媒体 | |
CN112254729A (zh) | 一种基于多传感器融合的移动机器人定位方法 | |
CN111025366B (zh) | 基于ins及gnss的网格slam的导航系统及方法 | |
CN111366153A (zh) | 一种激光雷达与imu紧耦合的定位方法 | |
CN112556681B (zh) | 一种基于视觉的果园机械导航定位方法 | |
CN115371665A (zh) | 一种基于深度相机和惯性融合的移动机器人定位方法 | |
CN112179373A (zh) | 一种视觉里程计的测量方法及视觉里程计 | |
EP3227634B1 (en) | Method and system for estimating relative angle between headings | |
CN112114660A (zh) | 一种利用人体足部在小空间范围内的运动来实现虚拟世界人物大范围移动的方法 | |
CN116659490A (zh) | 低成本视觉-惯性融合的slam方法 | |
CN115930948A (zh) | 一种果园机器人融合定位方法 | |
CN112923934A (zh) | 一种适用于非结构化场景中结合惯导的激光slam技术 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |