专利名称：一种农业机械的田间道路自动导航定位装置及方法
技术领域：
本发明属于计算机视觉图象处理应用领域，涉及一种农业机械的田间道路自动导航定位装置及方法。
背景技术：
目前，人们对机械的自动化程度要求越来越高；机械自动化作业及其机器人的发展是未来机械化发展方向；定位对自动作业车辆、机器人来说，非常重要。车辆、机器人在自动作业时，必须知道自己的位置，才可以决定机器人能否按要求完成下一步的执行任务。图像处理技术定位从图像中抽出特征从控制的范围分为局部定位和全球定位；局部定位运用于一定范围内的作业，计算机图象处理一般抽取有特色的特征物作为定位的基准，特征物分为自然物体和人工设置；全球定位，比如现在流行使用的GPS技术。从定位的性质分为几何定位和拓扑定位。几何定位能知道机器人的具体位置，拓扑定位是确定机器人在一定的可允许的范围路径内，并不知道详细的几何位置；对于各种机器人的定位研究不少，现在用于室外的机器人及车辆的定位基本上运用GPS技术，该定位技术误差比较大；在树林、房屋遮掩区域，因微波信号不能传输而不能使用；另外近年来一种在GPS技术上发展的RTK-GPS 技术，精度较高，但是价格昂贵。普通的车辆和作业机械尤其是农业机械及农业运输车，作业环境场所面积比较恶劣，尤其温室作业，GPS技术根本不可能实现自动导航定位。全方位视觉传感器是一种新型的视觉传感器，它能提供360度范围的丰富的信息，图像不会随传感器的旋转改变图像，有利于减少车轮滑移和震动的部分负面影响，而且价格便宜，被广泛应用在机器人领域；在机器人定位方向也得到了应用，但其使用原理和方法一般是在作业环境中人工设置特征物体或利用自然的特征物体，通过图像处理技术抽取特征值，然后通过图像匹配找到特征点或特征点区域来分析拓扑定位；该定位一般计算过程复杂、运行时间长，实用性不太好。发明专利一种自动导航定位装置及方法(申请号 200910044412. 4)，针对作业的车辆、机器人，尤其是作业环境比较固定，田间、温室、厂房等，以及GPS技术不能使用的区域，利用全方位视觉传感器和计算机视觉图像处理技术开发的一种自动导航定位装置及方法，该发明可代替GPS在一些特殊场合进行定位，运行速度较快、使用范围广、实用性强、价格便宜。该发明使用了 4个标识配合全方位视觉传感器来完成定位；由于田间道路较窄，布置4个标识费时，妨碍农业机械的行驶、GPS价格贵且存在使用限制等缺点。
发明内容
本发明所要解决的技术问题是提出一种农业机械的田间道路自动导航定位装置及方法，该农业机械的田间道路自动导航定位装置及方法可代替GPS进行定位，运行速度较快、使用范围广、实用性强、价格便宜。本发明的技术解决方案如下一种农业机械的田间道路自动导航定位方法，包括以下步骤
步骤1 准备工作在道路的同一侧设定2个有色标识L1和L2，在待定位的作业车上设有全方位视觉传感器，全方位视觉传感器拍摄当前的包含有2个有色标识成像的全方位图像；步骤2 测量在全方位图像中的投影中心分别到2个有色标识成像的成像实际距离，进而根据以下公式算出现实环境中作业车分别到2个有色标识的距离rl和r2 ；并根据全方位图像获得2个有色标识与全方位视觉传感器形成的方位角度θ工；由成像实际距离计算空间距离的公式如下
权利要求
1. 一种农业机械的田间道路自动导航定位方法，其特征在于，包括以下步骤 步骤1 准备工作在道路的同一侧设定2个有色标识L1和L2，在待定位的作业车上设有全方位视觉传感器，全方位视觉传感器拍摄当前的包含有2个有色标识成像的全方位图像；步骤2:测量在全方位图像中的投影中心分别到2个有色标识成像的成像实际距离，进而根据以下公式算出现实环境中作业车分别到2个有色标识的距离rl和r2 ；并根据全方位图像获得2个有色标识与全方位视觉传感器形成的方位角度θ工； 由成像实际距离计算空间距离的公式如下
2.根据权利要求1所述的农业机械的田间道路自动导航定位方法，其特征在于，步骤3 中，3个候选位置的坐标的求取方法如下首先，以某一个有色标识为原点，以两个标识的连线作为平面坐标的一个坐标轴，建立实际环境的平面坐标系；(xa，ya)为标识L1在所述平面坐标系中的位置坐标，(xb，yb)为标识L2在所述平面坐标系中的位置坐标；I)第一候选位置Il的坐标的求法 根据公式
3.根据权利要求1或2所述的农业机械的田间道路自动导航定位方法，其特征在于，成像实际距离的求取方法为首先计算有色标识成像到全方位视觉传感器投影中心的成像像素距离，再将该成像像素距离乘以标定像素距离计算成像实际距离。
4.根据权利要求3所述的农业机械的田间道路自动导航定位方法，其特征在于，标定像素距离为 0. 01389inch/pixel。
5.一种农业机械的田间道路自动导航定位装置，其特征在于，在在作业车所行使的道路的同一侧设定2个有色标识，在待定位的作业车上设有用于拍摄全方位图像的全方位视觉传感器，在作业车上还设有微处理器，微处理器中包含有1)用于从全方位图像中获取投影中心到2个有色标识的距离rl和r2、以及根据全方位图像获得2个有色标识与全方位视觉传感器形成的方位角度θ 1的图像处理单元和2~)用于根据权利要求2的农业机械的田间道路自动导航定位方法最终求出定位坐标的定位坐标计算单元。
6.根据权利要求5所述的农业机械的田间道路自动导航定位装置，其特征在于，所述的全方位视觉传感器采用双曲面透镜。
全文摘要
本发明公开了一种农业机械的田间道路自动导航定位装置及方法，在作业车所行使的道路的同一侧设定2个有色标识，在待定位的作业车上设有用于拍摄全方位图像的全方位视觉传感器，在作业车上还设有微处理器，微处理器中包含有1)用于从全方位图像中获取投影中心到2个有色标识的距离r1和r2、以及根据全方位图像获得2个有色标识与全方位视觉传感器形成的方位角度θ1的图像处理单元和2)用于根据农业机械的田间道路自动导航定位方法最终求出定位坐标的定位坐标计算单元。该农业机械的田间道路自动导航定位装置及方法可代替或补偿GPS进行定位，运行速度较快、使用范围广、实用性强、价格便宜。
文档编号G01C21/00GK102183250SQ20111000778
公开日2011年9月14日 申请日期2011年1月14日 优先权日2011年1月14日
发明者戴思慧, 李明 申请人:湖南农业大学