基于景物尺寸分析的移动机器人位置估计方法技术

本发明专利技术公开了基于天界线分析的移动机器人位置估计方法，所述的移动机器人内部设置进行集中控制的处理器，与所述的处理器连接的双目立体摄像机和惯性导航系统，所述的惯性导航系统用于计算所述的移动机器人的旋转角度θ，所述的处理器设置位置估计方法，包括以下步骤：(1)移动机器人在工作场所的中心位置，原地旋转一周；处理器每隔角度Δθ，采集图像f

Position estimation of mobile robot based on scene size analysis

【技术实现步骤摘要】
基于景物尺寸分析的移动机器人位置估计方法
本专利技术涉及基于景物尺寸分析的移动机器人位置估计方法，属于移动机器人

技术介绍
室外移动机器人工作在室外复杂多变的环境中，为了实现智能化的路径规划以及任务规划，需要具有全局意义的自定位。常规的定位方式是采用惯性导航的方法，比如通过安装在驱动轮上的编码器实时计算移动机器人的位移和转向，这类定位方法最大的弊端就是具有累计误差，即随着工作时间的累计，误差也在不断的累计，最终导致定位数据无效。也有基于激光雷达的方案，这种方案根据激光雷达的测距数据与事先建立的地图进行匹配，从而确定自身的位置。这种方案对硬件要求很高，并且算法复杂，目前还不能普及到普通室外移动机器人，比如割草机器人。随着机器视觉的硬件成本的降低和软件处理技术的发展，模拟人眼对位置和方向的估计成为一种成本可接受的可行方案。
技术实现思路
本专利技术的目的是为了克服现有技术中的不足之处，提出基于景物尺寸分析的移动机器人位置估计方法，以移动机器人工作环境四周的四周景物为参照，按照近大远小的原理，进行坐标估算，提供了不具有累计误差的位置信息。本专利技术解决其技术问题所采用的技术方案是：基于景物尺寸分析的移动机器人位置估计方法，所述的移动机器人内部设置进行集中控制的处理器，与所述的处理器连接的双目立体摄像机和惯性导航系统，所述的双目立体摄像机由两个光轴相互平行的第一摄像头和第二摄像头组成，所述的惯性导航系统用于计算所述的移动机器人的旋转角度θ，所述的处理器设置位置估计方法，所述的位置估计方法包括以下步骤：(1)所述的移动机器人设置在工作场所的中心位置，并原地旋转一周；所述的处理器每隔角度Δθ，通过所述的双目立体摄像机采集工作场景的图像fi1(x,y)和fi2(x,y)，其中，i=0…⌊2π/Δθ⌋-1，⌊⌋为向下取整；(2)所述的处理器基于fi1(x,y)和fi2(x,y)计算场景的深度di(x,y)；(3)所述的处理器搜索图像fi1(x,y)的中心线上的天界点(M/2,yi)，即天空与地面或者地面建筑、植物的交界点，然后写入方向地图数组A[i][0]=yi,A[i][1]=Hi，其中，M为fi1(x,y)和fi2(x,y)在x方向上的最大值，Hi=yi﹒p﹒di(M/2,yi)/f，为天界点的高度，p为像素尺寸，f为所述的第一摄像头的焦距；(4)所述的移动机器人在工作过程中需要确定自身位置的时候，所述的处理器通过所述的第一摄像头采集工作场景的图像f1(x,y)，根据方向地图数组A[i]确定自身方向β，读取方向地图数组A[⌊β/Δθ⌋-1][1]=H⌊β/Δθ⌋-1；(5)所述的处理器搜索图像f1(x,y)的中心线上的天界点(M/2,yk)，估算所述的移动机器人的位置坐标：x=(1/yk-1/yi)﹒f﹒Hi/p﹒cosβ，y=(1/yk-1/yi)﹒f﹒Hi/p﹒sinβ。所述的步骤(3)和步骤(5)中，天界点的计算方法为：如果y>Y，满足f1(x,y)>T1，其中T1为判断天空的亮度阈值；并且f1(x,Y)-f1(x,Y-1)>T2，则点(x,Y)为天界点，其中T2为天空到地面或者建筑物、植物的亮度梯度阈值。所述的步骤(4)中，方向β的计算方法为：(4-1)所述的处理器提取整个图像f1(x,y)的天界点y`=h(x)，取其中α/Δθ个数据组成采样数据B[j]={h(0)，h(⌊M·Δθ/α⌋)，h(⌊2·M·Δθ/α⌋，h(⌊3·M·Δθ/α⌋……}，其中，α为所述的第一摄像头的视角；(4-2)对采样数据B[j]与方向数组A[i][0]中的一段数据计算相似度，如果A[k][0]开始的一段数据，与采样数据B[j]相似度最大，则所述的割草机器人的方向为β=k﹒Δθ+α/2。实施本专利技术的积极效果是：1、以移动机器人工作环境四周的四周景物为参照，按照近大远小的原理，进行坐标估算；2、具有全局性质、并且不具有累计误差。附图说明图1是位置估计方法的流程图。具体实施方式现结合附图对本专利技术作进一步说明：参照图1，基于景物尺寸分析的移动机器人位置估计方法，所述的移动机器人内部设置进行集中控制的处理器，与所述的处理器连接的双目立体摄像机和惯性导航系统，所述的双目立体摄像机由两个光轴相互平行的第一摄像头和第二摄像头组成，可同时采集左右两幅图像，通过计算视差来获取深度信息；所述的惯性导航系统用于计算所述的移动机器人的旋转角度θ，设置为安装在驱动轮上的编码器，实时计算割所述的草机器人的位移和转向。所述的处理器设置位置估计方法，所述的位置估计方法包括以下步骤：(1)所述的移动机器人设置在工作场所的中心位置，并原地旋转一周；所述的处理器每隔角度Δθ，通过所述的双目立体摄像机采集工作场景的图像fi1(x,y)和fi2(x,y)，其中，i=0…⌊2π/Δθ⌋-1，⌊⌋为向下取整；步骤(1)是所述的移动机器人原地旋转，并在旋转过程中建立与方向相关的图像数据的过程。所述的惯性导航系统在短时间内，累计误差还比较小，角度信息还是可以信赖的。(2)所述的处理器基于fi1(x,y)和fi2(x,y)计算场景的深度di(x,y)；步骤(2)是基于双目立体视觉原理，根据视差信息，计算图像中的像素点的深度信息，即距离。(3)所述的处理器搜索图像fi1(x,y)的中心线上的天界点(M/2,yi)，即天空与地面或者地面建筑、植物的交界点，然后写入方向地图数组A[i][0]=yi,A[i][1]=Hi，其中，M为fi1(x,y)和fi2(x,y)在x方向上的最大值，Hi=yi﹒p﹒di(M/2,yi)/f，为天界点的高度，p为像素尺寸，f为所述的第一摄像头的焦距；步骤(3)是建立工作环境的地图。所述的移动机器人的工作环境是复杂多变的，并且特征也是多变，不具有稳定性。但是，天空与地面或者地面建筑植物的交界点具有不变性，可作为所述的移动机器人判别方向的依据，并且天界点Hi的高度，可进行后续步骤的位置估计。天界点Hi是基于成像模型基础得到的。所述的步骤(3)和步骤(5)中，天界点的计算方法为：如果y>Y，满足f1(x,y)>T1，其中T1为判断天空的亮度阈值；并且f1(x,Y)-f1(x,Y-1)>T2，则点(x,Y)为天界点，其中T2为天空到地面或者建筑物、植物的亮度梯度阈值。(4)所述的移动机器人在工作过程中需要确定自身位置的时候，所述的处理器通过所述的第一摄像头采集工作场景的图像f1(x,y)，根据方向地图数组A[i]确定自身方向β，读取方向地图数组A[⌊β/Δθ⌋-1][1]=H⌊β/Δθ⌋-1；当测量当前位置的时候，所述的移动机器人进行图像采集，得到图像f1(x,y)，然后计算所述的移动机器人的方向β，计算方法为：(4-1)所述的处理器提取整个图像f1(x,y)的天界点y`=h(x)，取其中α/Δθ个数据组成采样本文档来自技高网...

【技术保护点】
1.基于景物尺寸分析的移动机器人位置估计方法，所述的移动机器人内部设置进行集中控制的处理器，与所述的处理器连接的双目立体摄像机和惯性导航系统，所述的双目立体摄像机由两个光轴相互平行的第一摄像头和第二摄像头组成，所述的惯性导航系统用于计算所述的移动机器人的旋转角度θ，其特征在于：所述的处理器设置位置估计方法，所述的位置估计方法包括以下步骤：/n(1) 所述的移动机器人设置在工作场所的中心位置，并原地旋转一周；所述的处理器每隔角度Δθ，通过所述的双目立体摄像机采集工作场景的图像f

【技术特征摘要】
1.基于景物尺寸分析的移动机器人位置估计方法，所述的移动机器人内部设置进行集中控制的处理器，与所述的处理器连接的双目立体摄像机和惯性导航系统，所述的双目立体摄像机由两个光轴相互平行的第一摄像头和第二摄像头组成，所述的惯性导航系统用于计算所述的移动机器人的旋转角度θ，其特征在于：所述的处理器设置位置估计方法，所述的位置估计方法包括以下步骤：
(1)所述的移动机器人设置在工作场所的中心位置，并原地旋转一周；所述的处理器每隔角度Δθ，通过所述的双目立体摄像机采集工作场景的图像fi1(x,y)和fi2(x,y)，其中，i=0…⌊2π/Δθ⌋-1，⌊⌋为向下取整；
(2)所述的处理器基于fi1(x,y)和fi2(x,y)计算场景的深度di(x,y)；
(3)所述的处理器搜索图像fi1(x,y)的中心线上的天界点(M/2,yi)，即天空与地面或者地面建筑、植物的交界点，然后写入方向地图数组A[i][0]=yi,A[i][1]=Hi，其中，M为fi1(x,y)和fi2(x,y)在x方向上的最大值，Hi=yi﹒p﹒di(M/2,yi)/f，为天界点的高度，p为像素尺寸，f为所述的第一摄像头的焦距；
(4)所述的移动机器人在工作过程中需要确定自身位置的时候，所述的处理器通过所述的第一摄像头采集工作场景的图像f1(x,y)，根据方向地图数组A[i]确定自身方向β，读取方向地图数组A[⌊β/...

【专利技术属性】
技术研发人员：不公告发明人，
申请(专利权)人：杭州晶一智能科技有限公司，
类型：发明
国别省市：浙江;33