基于下倾立体相机的移动机器人前方坡度快速预测方法技术

公开一种基于下倾立体相机的移动机器人前方坡度快速预测方法，包括下倾设置在移动机器人前部的双目立体摄像机，光轴与所述的移动机器人的底盘的夹角为β，还包括与双目立体摄像机连接的处理器，处理器设置前方坡度预测方法，包括步骤：1、获取双目立体摄像机的图像对fL和fR，形成深度信息z；2、对于成像点a(x

Fast Slope Prediction Method for Mobile Robot Based on Downward Stereo Camera

A fast gradient prediction method for mobile robot front based on tilted stereo camera is disclosed. The method includes a binocular stereo camera which is tilted down in front of the mobile robot. The angle between the optical axis and the chassis of the mobile robot is beta. A processor connected with the binocular stereo camera is also included. The processor sets the gradient prediction method for mobile robot front, including steps: 1. Obtaining binocular stereo. The image of the camera forms depth information Z for fL and fR; 2. For imaging point a (x)

【技术实现步骤摘要】
基于下倾立体相机的移动机器人前方坡度快速预测方法
本专利技术涉及基于下倾立体相机的移动机器人前方坡度快速预测方法，属于移动机器人控制领域。
技术介绍
室外移动机器人工作环境非常复杂，其中地面的起伏情况就多变，可能是平地，也可能是上坡或者下坡，那么移动机器人提前获知该信息非常重要，不然可能导致倾倒等意外情况。对于采集地面情况信息的摄像机，光轴可以与室外移动机器人的地盘平行，也可以下倾设置。摄像机下倾设置可以将视野集中在地面，而不是天空及远处，但是也给计算带来一定难度。
技术实现思路
针对上述问题，本专利技术提供基于下倾立体相机的移动机器人前方坡度快速预测方法，为移动机器人检测前方地面的坡度信息。本专利技术解决其技术问题所采用的技术方案是：基于下倾立体相机的移动机器人前方坡度快速预测方法，包括设置在所述的移动机器人前部的双目立体摄像机，焦距为f，基线宽度为b，高度为h，所述的双目立体摄像机的光轴与所述的移动机器人的底盘的夹角为β，还包括与所述的双目立体摄像机连接的处理器，所述的处理器设置快速坡度预测方法，包括以下步骤：(1)所述的处理器获取所述的双目立体摄像机的图像对fL和fR，形成深度信息z=f(x,y)，x,y为像平面坐标，z为对应的深度；(2)对于成像点a(xA,yA)，投影角度θ=arctan(yA/f)，对应的实际点A的深度为zA=f(xA,yA)；(3)角度δ=π/2-β-θ；线段AO的长度l3=zA/cosθ；实际点A到光心O所在铅垂线的垂直距离l2=l3*sinδ；光心O到实际点A所在水平面的垂直距离l1=l3*cosδ；(4)如果垂直距离l1&gt;h，前方地面为下坡，实际点A到平坦地面的垂直距离为l1-h，则坡度为α=arctan（l1-h/l2)；如果垂直距离l1<h，地面为上坡，实际点A到平坦地面的垂直距离h-l1，则坡度为α=arctan(h-l1/l2)；如果垂直距离l1=h，则地面为平面，角度为α=0。本专利技术的有益效果主要表现在：1、可提前预测前方地面的坡度数值，为移动机器人运动控制提供环境信息。2、该方法计算简便，速度快，可精确计算前方地面的坡度数值。附图说明图1是移动机器人外形示意图；图2是移动机器人前方坡度预测方法原理示意图1；图3是移动机器人前方坡度预测方法原理示意图2。具体实施方式下面结合附图对本专利技术作进一步描述：参照图1－3，基于下倾立体相机的移动机器人前方坡度快速预测方法，包括设置在所述的移动机器人前部的双目立体摄像机，焦距为f，基线宽度为b，高度为h。所述的双目立体摄像机的光轴与所述的移动机器人的底盘的夹角为β，这样视野主要集中在地面，有利于提取有用信息。还包括与所述的双目立体摄像机连接的处理器，所述的处理器设置前方坡度预测方法，包括以下步骤：(1)所述的处理器获取所述的双目立体摄像机的图像对fL和fR，形成深度信息z=f(x,y)，x,y为像平面坐标，z为对应的深度；所述的处理器是根据视差原理来计算深度信息，利用所述的双目立体摄像机的参数，可得z=f(x,y)=f*b/d，其中d是根据图像对fL和fR计算得到的位置(x,y)的视差。(2)对于成像点a(xA,yA)，投影角度θ=arctan(yA/f)，则实际点A的深度为zA=f(xA,yA)；其中，深度zA是点A沿光轴到光心O的距离。(3)角度δ=π/2-β-θ；线段AO的长度l3=zA/cosθ；实际点A到光心O所在铅垂线的垂直距离l2=l3*sinδ；光心O到实际点A所在水平面的垂直距离l1=l3*cosδ；角度δ为直线AO与光心O所在铅垂线OO’的夹角，用于后续计算。首先，根据实际点A的深度zA，采用三角形余弦公式，可计算线段AO的长度l3=zA/cosθ；在三角形ΔOO"A中，可采用正弦公式，计算垂直距离l2=l3*sinδ，以及光心O到实际点A所在水平面的垂直距离l1=l3*cosδ。(4)如果垂直距离l1>h，前方地面为下坡，实际点A到平坦地面的垂直距离为l1-h，则坡度为α=arctan（l1-h/l2)；如果垂直距离l1<h，地面为上坡，实际点A到平坦地面的垂直距离h-l1，则坡度为α=arctan(h-l1/l2)；如果垂直距离l1=h，则地面为平面，角度为α=0。如图2，垂直距离l1>h，则前方地面为下坡，首先计算实际点A到平坦地面的垂直距离l1-h，再根据三角形的正切函数关系得到α=arctan（l1-h/l2)；如图3，垂直距离l1<h，则地面为上坡，首先计算实际点A到平坦地面的垂直距离h-l1，再根据三角形的正切函数关系得到α=arctan（h-l1/l2)。综上所述，通过上述方法，可迅速、快捷地计算基于下倾双目立体视觉的移动机器人前方地面坡度，为移动机器人的导航提供必要信息。本文档来自技高网...

【技术保护点】
1.基于下倾立体相机的移动机器人前方坡度快速预测方法，包括设置在所述的移动机器人前部的双目立体摄像机，焦距为f，基线宽度为b，高度为h，其特征在于：所述的双目立体摄像机的光轴与所述的移动机器人的底盘的夹角为β，还包括与所述的双目立体摄像机连接的处理器，所述的处理器设置快速坡度预测方法，包括以下步骤：(1) 所述的处理器获取所述的双目立体摄像机的图像对fL和fR，形成深度信息z=f(x,y)，x,y为像平面坐标，z为对应的深度；(2) 对于成像点a(x

【技术特征摘要】
1.基于下倾立体相机的移动机器人前方坡度快速预测方法，包括设置在所述的移动机器人前部的双目立体摄像机，焦距为f，基线宽度为b，高度为h，其特征在于：所述的双目立体摄像机的光轴与所述的移动机器人的底盘的夹角为β，还包括与所述的双目立体摄像机连接的处理器，所述的处理器设置快速坡度预测方法，包括以下步骤：(1)所述的处理器获取所述的双目立体摄像机的图像对fL和fR，形成深度信息z=f(x,y)，x,y为像平面坐标，z为对应的深度；(2)对于成像点a(xA,yA)，投影角度θ=arctan(yA/f)，对应的实际点A的...

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