技术领域
[0001] 本
发明涉及
电子技术领域，尤其涉及一种基于三维深度摄像机的近距离避障方法及近距离避障系统。
背景技术
[0002] 移动
机器人是通过
传感器来
感知环境，但是目前的传感器感知环境的能
力还不完善，感知传感器给出的数据不精确，感应范围存在盲区等。现有传感器中三维深度摄像头是一个较好的选择，具有获取环境
精度高，但是存在感应盲区的问题。目前的三维深度摄像机的成像原理大致分为两种：一种是通过结构光获取深度，红外激光发射相对随机但又固定的斑点图案，这些光斑打在物体上后，因为与摄像头距离不同，被摄像头捕捉到的
位置也不尽相同，然后计算拍到的图案的斑点与标定的标准图案在不同位置的位移；另一种是TOF(Time Of Flight)光学测距，计算光线飞行的时间，首先让装置发出脉冲光，并且在发射处接收目标物的反射光，即由测量时间差算出目标物的距离。
[0003] 三维深度摄像机获取的数据精确，但是由于其设备自身精度问题，在现有的避障方法中还未有用三维深度摄像机做三维避障的方法。因为三维深度摄像机存在近距离感知盲区，无法测量微小的位移或微小的时间变化，使其无法获取过近的物体的数据当障碍物处于盲区内将无法安全避障，比如kinect一代三维深度摄像机的近距离感知环境的范围为0.4m至3.5m，在0m至0.4m范围为kinect的工作盲区，当物体接近到机器人工作盲区或突然出现在机器人工作盲区时，kinect将无法发现障碍物，而无法实现安全避障，这对于
移动机器人如何安全自主避障是个很大的
缺陷。
[0004] 如果能够克服三维深度摄像机无法实现近距离安全避障的缺陷，则对三维避障的改进具有重要的意义。
发明内容
[0005] 本发明所要解决的技术问题是：如何利用三维深度摄像机实现近距离安全避障。
[0006] 为了解决上述技术问题，本发明采用的技术方案为：
[0007] 一种基于三维深度摄像机的近距离避障方法，包括：
[0008] 获取移动装置移动时前方的
深度图像，所述深度图像包括地面数据和空中数据；
[0009] 检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的
角度和距离，并根据计算出的角度和距离改变移动装置的移动路线；
[0010] 检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地面部分为障碍物，计算当前位置与障碍物的角度，根据计算出的角度改变移动装置的移动方向。
[0011] 上述基于三维深度摄像机的近距离避障方法的有益效果在于：移动装置移动时，获取移动装置前方的深度图像，根据深度图像判断是否存在障碍物，存在障碍物则计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线，防止移动装置按原来的移动路线移动与障碍物发生碰撞，实现安全避障；当障碍物与移动装置距离比较近时，不能直接从深度图像判断是否有障碍物，而是通过检测深度图像是否存在部分或全部地面数据无法获取的情况，如果部分或全部地面数据无法获取则判定无法获取数据的地面部分为障碍物，并计算当前位置与障碍物的角度，从而准确判断出近距离障碍物以及近距离障碍物的位置，由于此时障碍物与移动装置距离比较近，从而立即改变移动装置的移动方向，安全实现近距离避障。
[0012] 一种基于三维深度摄像机的近距离避障系统，包括：三维深度摄像机、上位机、下位机、通信装置以及移动装置，所述移动装置在地面上移动；
[0013] 所述三维深度摄像机安装于移动装置上，用于获取移动装置前方的深度图像，所述深度图像包括地面数据和空中数据；并将所述深度图像通过通信装置发送给上位机；
[0014] 所述上位机用于检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线，并向下位机发送改变移动装置移动路线的控制命令；检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地面部分为障碍物，计算当前位置与障碍物的角度，根据计算出的角度改变移动装置的移动方向，并向下位机发送改变移动装置移动方向的控制命令；
[0015] 所述下位机用于根据所述控制命令控制移动装置移动。
[0016] 上述基于三维深度摄像机的近距离避障系统的有益效果在于：三维深度摄像机安装于移动装置上，通过三维深度摄像机来获取移动装置前方的深度图像，深度图像精度高，可以精确地得知移动装置前方的环境；上位机通过通信装置的得到三维深度摄像机获取的深度图像，移动装置与障碍物距离比较远时，上位机可直接根据深度图像判断是否存在障碍物，存在障碍物时计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离发送改变路线的控制命令给下位机，当移动装置与障碍物距离比较近时，不能直接从深度图像判断是否有障碍物，而是通过检测深度图像是否存在部分或全部地面数据无法获取的情况，如果部分或全部地面数据无法获取则判定该无法获取数据的地面部分为障碍物，并计算当前位置与障碍物的角度，根据计算出的角度发送立即改变移动方向的控制命令给下位机，下位机根据控制命令控制移动装置移动，从而在近距离和远距离的情况下都能实现安全避障。
附图说明
[0017] 图1为本发明
实施例一基于三维深度摄像机的近距离避障方法
流程图；
[0018] 图2为本发明实施例二基于三维深度摄像机的近距离避障系统结构图。
[0019] 标号说明：
[0020] 1、三维深度摄像机；2、通信装置；3、上位机；4、下位机。
具体实施方式
[0021] 为详细说明本发明的技术内容、所实现目的及效果，以下结合实施方式并配合附图予以说明。
[0022] 本发明最关键的构思在于:采用三维深度摄像机获取移动装置前方的深度图像，近距离避障时，通过分析深度图像的地面数据无法获取的部分判断是否存在障碍物，实现近距离安全避障。
[0023] 请参照图1，
[0024] 一种基于三维深度摄像机的近距离避障方法，包括：
[0025] S1、获取移动装置移动时前方的深度图像，所述深度图像包括地面数据和空中数据；
[0026] S2、检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线；
[0027] S3、检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地面部分为障碍物，计算当前位置与障碍物的角度，根据计算出的角度改变移动装置的移动方向。
[0028] 上述基于三维深度摄像机的近距离避障方法的有益效果在于：移动装置移动时，获取移动装置前方的深度图像，根据深度图像判断是否存在障碍物，存在障碍物则计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线，防止移动装置按原来的移动路线移动与障碍物发生碰撞，实现安全避障；当障碍物与移动装置距离比较近时，不能直接从深度图像判断是否有障碍物，而是通过检测深度图像是否存在部分或全部地面数据无法获取的情况，如果部分或全部地面数据无法获取则判定无法获取数据的地面部分为障碍物，并计算当前位置与障碍物的角度，从而准确判断出近距离障碍物以及近距离障碍物的位置，由于此时障碍物与移动装置距离比较近，从而立即改变移动装置的移动方向，安全实现近距离避障。
[0029] 进一步的，所述“获取移动装置移动时前方场景的深度图像”之前还包括：获取移动装置在无障碍物的
水平地面静止时前方的深度图像，记录无障碍物情况下地面数据位于深度图像的最下面的行数N。
[0030] 进一步的，所述“计算当前位置与障碍物的角度”具体为：
[0031] 计算每个角度内当前地面数据在当前深度图像最下面N行中的三维数据点的个数；
[0032] 当三维数据点个数为0时，判定三维数据点的个数为0的角度为障碍物存在的角度。
[0033] 从上述描述可知，由于障碍物遮挡了三维深度摄像机获取地面数据，导致有障碍物的区域无法获取任何数据，表现为最下面的N行数据即地面部分出现一
块空白，因此通过对比当前地面数据与无障碍物情况下地面数据，从而根据地面数据的三维数据点个数判断有无障碍物，没有三维数据点则说明有障碍物。
[0034] 进一步的，所述地面数据和空中数据为三维数据。
[0035] 请参照图2，
[0036] 一种基于三维深度摄像机的近距离避障系统，包括：三维深度摄像机1、上位机3、下位机4、通信装置2以及移动装置，所述移动装置在地面上移动；
[0037] 所述三维深度摄像机1安装于移动装置上，用于获取移动装置前方的深度图像，所述深度图像包括地面数据和空中数据；并将所述深度图像通过通信装置2发送给上位机3；
[0038] 所述上位机3用于检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线，并向下位机4发送改变移动装置移动路线的控制命令；检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地面部分为障碍物，计算当前位置与障碍物的角度，根据计算出的角度改变移动装置的移动方向，并向下位机4发送改变移动装置移动方向的控制命令；
[0039] 所述下位机4用于根据所述控制命令控制移动装置移动。
[0040] 上述基于三维深度摄像机的近距离避障系统的有益效果在于：三维深度摄像机1安装于移动装置上，通过三维深度摄像机1来获取移动装置前方的深度图像，深度图像精度高，可以精确地得知移动装置前方的环境；上位机3通过通信装置2的得到三维深度摄像机1获取的深度图像，移动装置与障碍物距离比较远时，上位机3可直接根据深度图像判断是否存在障碍物，存在障碍物时计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离发送改变路线的控制命令给下位机4，当移动装置与障碍物距离比较近时，不能直接从深度图像判断是否有障碍物，而是通过检测深度图像是否存在部分或全部地面数据无法获取的情况，如果部分或全部地面数据无法获取则判定该无法获取数据的地面部分为障碍物，并计算当前位置与障碍物的角度，根据计算出的角度发送立即改变移动方向的控制命令给下位机4，下位机4根据控制命令控制移动装置移动，从而在近距离和远距离的情况下都能实现安全避障。
[0041] 进一步的，所述三维深度摄像机1水平或倾斜向下安装于移动装置上。
[0042] 从上述描述可知，三维深度摄像机1水平或倾斜向下安装于移动装置上能够保证三维深度摄像机1能拍摄到地面部分。
[0043] 进一步的，所述上位机3为计算机。
[0044] 进一步的，所述下位机4为可编程逻辑编辑器或
单片机。
[0045] 请参照图1，本发明的实施例一为：
[0046] 一种基于三维深度摄像机的近距离避障方法，包括：
[0047] 获取移动装置在无障碍物的水平地面静止时前方的深度图像，所述深度图像包括地面数据和空中数据；所述地面数据和空中数据为三维数据；记录无障碍物情况下地面数据位于深度图像的最下面的行数N；
[0048] S1、获取移动装置移动时前方的深度图像，所述深度图像包括地面数据和空中数据；所述地面数据和空中数据为三维数据；
[0049] S2、检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线；当移动装置与障碍物距离较远时，一般情况下为距离大于0.4米时，可直接从深度图像判断地面是否存在障碍物，获取图像时需要发射脉冲光，获取到深度图像时需要收到反射的脉冲光；存在障碍物时根据发射脉冲光与收到反射的脉冲光的时间差得到当前位置与障碍物的距离；
[0050] S3、检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地面部分为障碍物，计算每个角度内当前地面数据在当前深度图像最下面N行中的三维数据点的个数；当三维数据点个数为0时，判定三维数据点的个数为0的角度为障碍物存在的角度；根据计算出的角度改变移动装置的移动方向；当移动装置与障碍物距离较近时，一般情况下为距离小于0.4米时，由于障碍物遮挡了地面数据，导致有障碍物的区域无法获得任何数据，表现为最下面的N行数据即地面部分出现一块空白，因此判定该空白为障碍物造成的，即该无数据的地面部分为障碍物。
[0051] 请参照图2，本发明的实施例二为：
[0052] 一种基于三维深度摄像机的近距离避障系统，包括：三维深度摄像机1、上位机3、下位机4、通信装置2以及移动装置，所述移动装置在地面上移动；优选的，所述移动装置按照规划的路径移动；优选的，所述移动装置为机器人；
[0053] 所述三维深度摄像机1安装于移动装置上，用于获取移动装置前方的深度图像，所述深度图像包括地面数据和空中数据；优选的，所述三维深度摄像机1水平或倾斜向下安装于移动装置上，保证三维深度摄像机1能够拍摄到地面数据；并将所述深度图像通过通信装置2发送给上位机3；
[0054] 所述上位机3用于检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线，并向下位机4发送改变移动装置移动路线的控制命令；检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地面部分为障碍物，计算当前位置与障碍物的角度，根据计算出的角度改变移动装置的移动方向，并向下位机4发送改变移动装置移动方向的控制命令；优选的，所述上位机3为计算机；
[0055] 所述下位机4用于根据所述控制命令控制移动装置移动，优选的，所述下位机4为可编程逻辑编辑器或单片机，优选的，所述下位机4安装于移动装置上。
[0056] 综上所述，本发明提供的一种基于三维深度摄像机的近距离避障方法及近距离避障系统，采用三维深度摄像机获取移动装置前方的深度图像，并通过通信装置将获取的深度图像发送给上位机；远距离避障时，上位机根据深度图像判断是否存在障碍物，存在障碍物时计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离发送改变移动装置的移动路线的控制命令给下位机，下位机控制移动装置改变移动路线，从而安全实现远距离避障；近距离避障时，上位机根据移动装置前方是否出现部分或全部地面数据无法获取的现象判断是否存在障碍物，如果部分或全部地面数据无法获取则判定存在障碍物且无数据的地面部分即为障碍物；并计算当前位置与障碍物之间的角度，根据计算出的角度发送立即改变移动方向的控制命令给下位机，下位机控制移动装置立即改变移动方向，从而安全实现近距离避障。
[0057] 以上所述仅为本发明的实施例，并非因此限制本发明的
专利范围，凡是利用本发明
说明书及附图内容所作的等同变换，或直接或间接运用在相关的技术领域，均同理包括在本发明的专利保护范围内。
