CN204695100U - 机器人用深度摄像头与超声波结合的避障控制装置 - Google Patents

Abstract

本实用新型公开了一种机器人用深度摄像头与超声波结合的避障控制装置，该装置包括安设在机器人上且用于判断机器人体姿0.3-4m内是否有外障碍物体的深度数据摄像头；安设在机器人上且用于判断距离机器人体姿0-0.3m内是否有内障碍物体的超声波测距模块；安设在机器人体内其用于对内、外障碍物体的障碍信息进行处理的控制模块；用于显示障碍信息的显示屏；深度数据摄像头和超声波测距模块分别与控制模块的输入端电连接，且控制模块的输出端与显示屏电连接。本实用新型实现了机器人对环境的无盲区探测，在行走过程中可有效避开障碍物体。

Description

机器人用深度摄像头与超声波结合的避障控制装置

技术领域

本实用新型涉及机器人技术领域，尤其涉及一种机器人用深度摄像头与超声波结合的避障控制装置。

背景技术

智能机器人，例如扫地机器人等越来越广泛的应用于家庭生活中，机器人要实现灵活、高效、智能的移动，就需要具有自主导航的功能。地图创建、定位及路径规划是自主导航的三个关键要素，地图创建与定位是相互依存的关系，缺少环境地图则无法准确的标定机器人的位置，初始位置不确定，则创建的地图就会缺少基准点，正因如此未知环境下的机器人的地位与地图创建将以同时定位与地图创建的方式实现，即是移动机器人随着对环境的探索，逐步扩大自身存储的地图的广度，并实时的将未知信息定位在新创建的地图中，这种技术一般称之为同时定位与地图生成。目前，较为常用的智能机器人的同时定位与地图生成技术包括FastSLAM与vSLAM两大类。其中FastSLAM系统一般使用激光测距仪或声纳来实现，而vSLAM则使用视觉传感器来实现。FastSLAM由于使用了激光、声纳等传感器，对一些特殊的环境如线段、拐角等不能识别，因此需要通过改进算法来实现定位的准确性。

综合上述的描述，传统机器人的定位避障方法只能避开距离机器人长距离的障碍物体，而且无法准确定位出障碍物体所在的具体位置，因此存在误差、盲区和反射角度等局限性。

实用新型内容

针对上述技术中存在的不足之处，本实用新型提供一种机器人用深度摄像头与超声波结合的避障控制装置，实现了机器人对环境的无盲区探测，在行走过程中可有效避开障碍物体。

为实现上述目的，本实用新型提供一种机器人用深度摄像头与超声波结合的避障控制装置，包括安设在机器人上且用于判断机器人体姿0.3-4m内是否有外障碍物体的深度数据摄像头；安设在机器人上且用于判断距离机器人体姿0-0.3m内是否有内障碍物体的超声波测距模块；安设在机器人体内其用于对内、外障碍物体的障碍信息进行处理的控制模块；用于显示障碍信息的显示屏；

所述深度数据摄像头和超声波测距模块分别与控制模块的输入端电连接，且所述控制模块的输出端与显示屏电连接。

其中，所述机器人上还安设有用于侦测声源并获取声音信号的阵列麦克风，所述阵列麦克风与控制模块的输入端电连接，所述阵列麦克风侦测到开始探索的指令后，传输给控制模块处理后，机器人开始行走和探索。

其中，所述深度数据摄像头在360度内分固定拍摄角度和七次旋转拍摄角度，所述固定拍摄角度为60度，七次旋转拍摄角度具体为第一次旋转角度为30度、第二次旋转角度为60度、第三次旋转角度为30度、第四次旋转角度为60度、第五次旋转角度为30度、第六次旋转角度为60度和第七次旋转角度为30度。

其中，所述超声波测距模块包括单片机、定时单元和转换单元，所述单片机上设有触发端和回声引脚，所述单片机的输出端与定时单元电连接，所述回声引脚通过转换单元与控制模块电连接；触发端触发后，回声引脚得到高电平，定时单元开启工作后，回声引脚由高电平转为低电平，且低电平信号通过转换单元转化为实际距离数值并在显示屏上进行显示。

其中，述深度数据摄像头包括用于投射随机点阵的红外传感器和用于扑捉点阵的CMOS传感器，且所述CMOS传感器上带有红外滤波器；所述红外传感器通过红外滤波器与CMOS传感器电连接，且该CMOS传感器与控制模块的输入端电连接。

本实用新型的有益效果是：与现有技术相比，本实用新型提供的机器人用深度摄像头与超声波结合的避障控制装置，由机器人在行走过程中不断的对外障碍物体进行探索，由深度数据摄像头检测距离机器人体姿0.3-4m之间是否有外障碍物体，由机器人上安设的超声波测距模块判断距离机器人体姿0-0.3m以内是否有内障碍物体；并将障碍物体的障碍信息在显示屏上进行显示，最后，根据显示屏上的显示确定机器人行走避开内、外障碍物体的可行走路线。本实用新型的改进，实现了机器人对环境的无盲区探测，有效解决存在着盲区和反射角度等局限性问题，在行走过程中可有效避开障碍物体，提高了该机器人的工作效率。

附图说明

图1为本实用新型的机器人用深度摄像头与超声波结合的避障控制装置的工作方框图；

图2为本实用新型中深度数据摄像头的旋转方式图；

图3为本发明深度数据摄像头获得深度图像的结构图；

图4为本实用新型中显示屏上显示首次获得障碍信息的示意图；

图5为本实用新型获得内外障碍物体障碍信息的示意图。

主要元件符号说明如下：

10、深度数据摄像头      11、超声波测距模块

12、控制模块            13、显示屏

14、阵列麦克风          111、单片机

112、触发端              113、回声引脚

114、定时单元            115、转换单元

101、红外传感器          102、CMOS传感器

103、红外滤波器

15、机器人。

具体实施方式                                        

为了更清楚地表述本实用新型，下面结合附图对本实用新型作进一步地描述。

请参阅图1-5，本实用新型的机器人用深度摄像头与超声波结合的避障控制装置，包括安设在机器人15上且用于判断机器人15体姿0.3-4m内是否有外障碍物体的深度数据摄像头10；安设在机器人15上且用于判断距离机器人体姿0-0.3m内是否有内障碍物体的超声波测距模块11；安设在机器人体15内其用于对内、外障碍物体的障碍信息进行处理的控制模块12；用于显示障碍信息的显示屏13；深度数据摄像头10和超声波测距模块11分别与控制模块12的输入端电连接，且控制模块12的输出端与显示屏13电连接。

本实用新型提供的机器人用深度摄像头与超声波结合的避障控制装置，由机器人在行走过程中不断的对外障碍物体进行探索，由深度数据摄像头10检测距离机器人12体姿0.3-4m之间是否有外障碍物体，由机器人15上安设的超声波测距模块判断距离机器人体姿0-0.3m以内是否有内障碍物体；并将障碍物体的障碍信息在显示屏上进行显示，最后，根据显示屏12上的显示确定机器人行走避开内、外障碍物体的可行走路线。本实用新型的改进，实现了机器人对环境的无盲区探测，有效解决存在着盲区和反射角度等局限性问题，在行走过程中可有效避开障碍物体，提高了该机器人的工作效率。

在本实施例中，机器人15上还安设有用于侦测声源并获取声音信号的阵列麦克风14，阵列麦克风14与控制模块12的输入端电连接，阵列麦克风14侦测到开始探索的指令后，传输给控制模块12处理后，机器人开始行走和探索。

请参阅图2，深度数据摄像头在360度内分固定拍摄角度和七次旋转拍摄角度，固定拍摄角度为60度，七次旋转拍摄角度具体为第一次旋转角度为30度、第二次旋转角度为60度、第三次旋转角度为30度、第四次旋转角度为60度、第五次旋转角度为30度、第六次旋转角度为60度和第七次旋转角度为30度；固定拍摄角度即为图2中的首次旋转角度。由于每次旋转的度数不同，则可避免采集到重复的图像。当然，深度数据摄像头的旋转次数并不局限，还可以是每次都旋转60度，就旋转5次，还可以是其他旋转方式，只要能保证360度内拍摄的图像不重复即可。

在本实施例中，超声波测距模块11包括单片机111、定时单元114和转换单元115，单片机111上设有触发端112和回声引脚113，单片机111的输出端与定时单元114电连接，回声引脚113通过转换单元114与控制模块12电连接；触发端触发后，回声引脚113得到高电平，定时单元114开启工作后，回声引脚114由高电平转为低电平，则距离机器人体姿0-0.3m内有内障碍物体，且反馈回来的低电平信号通过转换单元转化为实际距离数值并在显示屏上进行显示；若无低电平，则机器人0-0.3m以内没有内障碍物体。深度数据摄像头10包括用于投射随机点阵的红外传感器101和用于扑捉点阵的CMOS传感器102，且CMOS传感器102上带有红外滤波器103；红外传感器101通过红外滤波器102与CMOS传感器103电连接。红外滤波器103可对红外传感器101感应到的信号进行滤波过滤，使得CMOS传感器103最终得到的图片结果更准确。

本实用新型的具体工作步骤如下：

第一步，打开机器人电源，初始化开始，给机器人发送声音指令：开始探索。

第二步，机器人开始进行行走和探索。

第三步，机器人上安设的深度数据摄像头摄取当前体姿0.3-4m、拍摄角度为60度的深度图像；若是遇到外障碍物体，则进入步骤第四步，若是未遇到外障碍物体，则返回第二步。

第四步，获取机器人到外障碍物体的深度信息Z，根据深度信息Z利用三角公式计算并获得首次障碍信息的深度图像的x和y，x表示外障碍物体到机器人原点的距离，y表示外障碍物体的高度。

第五步，将获取的首次障碍信息的深度图像x和y按一定的比例映射到显示屏的x轴和y轴上并保存。

第六步，分多次旋转深度数据摄像头360度中的剩余角度，每旋转一次深度数据摄像头就根据上述的三角公式获取一个新的障碍信息的深度图像的x和y，直到转完360度后则将所有障碍信息显示在显示屏上；由于深度图像的分辨率为320*200，并且深度数据摄像头到分辨率最大值是的角度是60度；因此三角公式为α=(x/320)*60,利用y=Z * cos(α),y表示以Z为斜边，x=Z * sin(α)。如图3所示，其中x与y构成的直角三角形的边。

第七步，由机器人上安设的超声波测距模块判断距离机器人体姿0-0.3m以内是否有内障碍物体，若有内障碍物体，则计算出内障碍物体到机器人的距离并在显示屏上进行显示；若无内障碍物体，则跳出检测；具体步骤为：超声波测距模块触发后，等待回声引脚高电平的到来；回声引脚高电平到来后，开始计时，开启定时单元的40ms超时溢出功能；在40ms内有低电平的到来，则检测结束，并计算出内障碍物体到机器人的距离；若40ms内无低电平则跳出判断，说明没有检测到内障碍物体，机器人体姿0-0.3m以内没有内障碍物体。

第八步，根据显示屏上的显示确定机器人行走避开内、外障碍物体的可行走路线。

图4为深度数据摄像头首次拍摄后得到的在显示屏上的显示结果，该图中圆点表示机器人15，A区域表示机器人可以行走的的区域，B区域表示机器人不可以行走的的区域，明显可以看出行走的区域范围是很大的。如图5为深度数据摄像头再转7次，转动完成后先保存前一个60度所获得的障碍信息，并与转动后获得的障碍信息同时显示在屏幕上，直到转完360度后则将所有信息拼装成完整的矩形在显示屏上进行显示，而且由超声波测距模块判断距离机器人体姿0-0.3m以内是否有内障碍物体后得到的最走行走图，该图中A区域表示机器人可以行走的的区域，B区域表示机器人不可以行走的的区域，明显可以看出通过深度的拍摄及超声波测距模块判断后，机器人可走的范围大大减小，该结果说明了深度数据摄像头与超声波测距模块的结合，使得避障结果更准确。

以上公开的仅为本实用新型的几个具体实施例，但是本实用新型并非局限于此，任何本领域的技术人员能思之的变化都应落入本实用新型的保护范围。

Claims (5)

1.一种机器人用深度摄像头与超声波结合的避障控制装置，其特征在于，包括安设在机器人上且用于判断机器人体姿0.3-4m内是否有外障碍物体的深度数据摄像头；安设在机器人上且用于判断距离机器人体姿0-0.3m内是否有内障碍物体的超声波测距模块；安设在机器人体内其用于对内、外障碍物体的障碍信息进行处理的控制模块；用于显示障碍信息的显示屏；

所述深度数据摄像头和超声波测距模块分别与控制模块的输入端电连接，且所述控制模块的输出端与显示屏电连接。

2.根据权利要求1所述的机器人用深度摄像头与超声波结合的避障控制装置，其特征在于，所述机器人上还安设有用于侦测声源并获取声音信号的阵列麦克风，所述阵列麦克风与控制模块的输入端电连接，所述阵列麦克风侦测到开始探索的指令后，传输给控制模块处理后，机器人开始行走和探索。

3.根据权利要求1所述的机器人用深度摄像头与超声波结合的避障控制装置，其特征在于，所述深度数据摄像头在360度内分固定拍摄角度和七次旋转拍摄角度，所述固定拍摄角度为60度，七次旋转拍摄角度具体为第一次旋转角度为30度、第二次旋转角度为60度、第三次旋转角度为30度、第四次旋转角度为60度、第五次旋转角度为30度、第六次旋转角度为60度和第七次旋转角度为30度。

4.根据权利要求1所述的机器人用深度摄像头与超声波结合的避障控制装置，其特征在于，所述超声波测距模块包括单片机、定时单元和转换单元，所述单片机上设有触发端和回声引脚，所述单片机的输出端与定时单元电连接，所述回声引脚通过转换单元与控制模块电连接；触发端触发后，回声引脚得到高电平，定时单元开启工作后，回声引脚由高电平转为低电平，且低电平信号通过转换单元转化为实际距离数值并在显示屏上进行显示。

5.根据权利要求1所述的机器人用深度摄像头与超声波结合的避障控制装置，其特征在于，所述深度数据摄像头包括用于投射随机点阵的红外传感器和用于扑捉点阵的CMOS传感器，且所述CMOS传感器上带有红外滤波器；所述红外传感器通过红外滤波器与CMOS传感器电连接，且该CMOS传感器与控制模块的输入端电连接。