[发明专利]四触角履带机器人爬楼梯参数获取系统和方法

说明书

技术领域

本发明公开了一种四触角履带机器人爬楼梯参数获取系统与方法，涉及机器人视觉，模式识别技术领域。

背景技术

移动机器人在室内或人造室外环境中具备自主识别楼梯的参数能力，对于灾害中搜救和自主导航有重要的作用。履带机器人对地形的适应性使其特别适合用于自主爬楼梯研究的平台。在移动机器人上搭载单目相机，双目相机，成像雷达以及激光成像设备，获取环境信息使机器人自主导航。目前，这些传感设备不能很好的解决楼梯参数获取的功能且设备价钱昂贵。

Kinect XBOX360是微软一种3D体感摄影机，同时它导入了即时动态捕捉、影像辨识、麦克风输入、语音辨识等功能。目前，Kinect XBOX360可以通过USB接口与机器人控制器相连，是移动机器人三维视觉数据的有效来源。Kinect XBOX360是一款价格低廉的传感设备，在机器人研究社区掀起一股研究热潮。

发明内容

为了克服上述现有技术的不足和利用Kinect XBOX360体感传感器的优势，本发明提供了一种四触角履带机器人爬楼梯参数获取系统与方法，解决在四触角履带机器人爬楼梯过程中楼梯参数获取的问题，能有效的计算出楼梯踏步的深度和高度及倾角，用于四触角履带机器人自主爬楼梯。

为了达到上述目的，本发明的构思是：Kinect XBOX360的RGB图像和深度图像信息融合起来，采用四触角履带机器人作为移动平台，解决在四触角履带机器人爬楼梯过程中楼梯参数获取的问题，能有效的计算出楼梯踏步的深度和高度及倾角，用于四触角履带机器人自主爬楼梯。

根据上述发明构思，本发明采用下述技术方案：

一种四触角履带机器人爬楼梯参数获取系统，包括装有控制电脑的四触角履带机器人和微软公司的Kinect XBOX360摄像头，其特征在于：所述微软公司的Kinect XBOX360摄像头安装在四触角履带机器人上面，通过USB接口连接四触角履带机器人的控制电脑，获取Kinect XBOX360摄像头对楼梯摄取的RGB彩色和深度图像经过处理信息融合，计算楼梯的相关参数。

一种四触角履带机器人爬楼梯参数获取方法，采用上述的四触角履带机器人爬楼梯参数获取系统进行楼梯参数计算，其特征在于：其操作步骤如下：

（1）相机标定：利用张正友相机标定法，获取Kinect XBOX360摄像头的参数矩阵K：

                                                                                           ，

其中：f—相机的焦距； s—相机的扭曲系数； —主点偏置；

（2）图像获取：打开Kinect XBOX360摄像头，获取Kinect XBOX360的RGB图像和深度图像数据；

（3）创建各计算节点：Kinect XBOX360摄像头的图像数据包含RGB图像和深度图像，各计算节点分别从上述图像中计算与楼梯相关的信息；本步骤（3）包含以下计算节点：

①楼梯边缘提取：利用Kinect XBOX360摄像头的RGB图像数据，采用霍夫变换算法提取楼梯边缘直线：

                                         ，

其中：ρ—图像原点到直线的距离，θ_l—直线的倾角；

②楼梯踏步深度d：取楼梯三个相邻边缘为基准，在图像中取20*20区域的平均深度值作为衡量，两块区域的深度差值即楼梯踏步深度d；

③楼梯踏步高度H：利用三角形相似性原理，解出楼梯踏步高度H：

，

其中：f-相机的焦距，h-楼梯相邻两个边缘之间的图像平面中的垂直高度，dp-楼梯踏步的垂直面的深度值；

④楼梯倾角θ；根据步骤②和③所求出的楼梯踏步深度d和楼梯踏步高度H，解出楼梯倾角θ：

；

本发明与现有技术相比，具有如下显而易见的突出实质性特点和显著优点：本发明在四触角履带机器人平台上能有效地获取爬楼梯参数。四触角履带机器人能够在室内或室外人造环境中具有很好的适应性，完成救援和自主导航的功能。

附图说明

图1为本发明的方法原理图。

图2为本发明的一个实施例的系统结构示意图。

图3为楼梯的基本属性示意图。

图4为楼梯边缘直线检测方法示意图。