[发明专利]一种农业机械的田间道路自动导航定位装置及方法

说明书

技术领域

本发明属于计算机视觉图象处理应用领域，涉及一种农业机械的田间道路自动导航定位装置及方法。

背景技术

目前，人们对机械的自动化程度要求越来越高；机械自动化作业及其机器人的发展是未来机械化发展方向；定位对自动作业车辆、机器人来说，非常重要。车辆、机器人在自动作业时，必须知道自己的位置，才可以决定机器人能否按要求完成下一步的执行任务。图像处理技术定位从图像中抽出特征从控制的范围分为局部定位和全球定位；局部定位运用于一定范围内的作业，计算机图象处理一般抽取有特色的特征物作为定位的基准，特征物分为自然物体和人工设置；全球定位，比如现在流行使用的GPS技术。从定位的性质分为几何定位和拓扑定位。几何定位能知道机器人的具体位置，拓扑定位是确定机器人在一定的可允许的范围路径内，并不知道详细的几何位置；对于各种机器人的定位研究不少，现在用于室外的机器人及车辆的定位基本上运用GPS技术，该定位技术误差比较大；在树林、房屋遮掩区域，因微波信号不能传输而不能使用；另外近年来一种在GPS技术上发展的RTK-GPS技术，精度较高，但是价格昂贵。普通的车辆和作业机械尤其是农业机械及农业运输车，作业环境场所面积比较恶劣，尤其温室作业，GPS技术根本不可能实现自动导航定位。

全方位视觉传感器是一种新型的视觉传感器，它能提供360度范围的丰富的信息，图像不会随传感器的旋转改变图像，有利于减少车轮滑移和震动的部分负面影响，而且价格便宜，被广泛应用在机器人领域；在机器人定位方向也得到了应用，但其使用原理和方法一般是在作业环境中人工设置特征物体或利用自然的特征物体，通过图像处理技术抽取特征值，然后通过图像匹配找到特征点或特征点区域来分析拓扑定位；该定位一般计算过程复杂、运行时间长，实用性不太好。发明专利：一种自动导航定位装置及方法(申请号：200910044412.4)，针对作业的车辆、机器人，尤其是作业环境比较固定，田间、温室、厂房等，以及GPS技术不能使用的区域，利用全方位视觉传感器和计算机视觉图像处理技术开发的一种自动导航定位装置及方法，该发明可代替GPS在一些特殊场合进行定位，运行速度较快、使用范围广、 实用性强、价格便宜。该发明使用了4个标识配合全方位视觉传感器来完成定位；由于田间道路较窄，布置4个标识费时，妨碍农业机械的行驶、GPS价格贵且存在使用限制等缺点。

发明内容

本发明所要解决的技术问题是提出一种农业机械的田间道路自动导航定位装置及方法，该农业机械的田间道路自动导航定位装置及方法可代替GPS进行定位，运行速度较快、使用范围广、实用性强、价格便宜。

本发明的技术解决方案如下：

一种农业机械的田间道路自动导航定位方法，包括以下步骤：

步骤1：准备工作：在道路的同一侧设定2个有色标识L₁和L₂，在待定位的作业车上设有全方位视觉传感器，全方位视觉传感器拍摄当前的包含有2个有色标识成像的全方位图像；

步骤2：测量在全方位图像中的投影中心分别到2个有色标识成像的成像实际距离，进而根据以下公式算出现实环境中作业车分别到2个有色标识的距离r1和r2；并根据全方位图像获得2个有色标识与全方位视觉传感器形成的方位角度θ₁；

由成像实际距离计算空间距离的公式如下：