基于三维深度摄像机的近距离避障方法及近距离避障系统的制作方法
【技术领域】
[0001]本发明涉及电子技术领域，尤其涉及一种基于三维深度摄像机的近距离避障方法及近距离避障系统。
【背景技术】
[0002]移动机器人是通过传感器来感知环境，但是目前的传感器感知环境的能力还不完善，感知传感器给出的数据不精确，感应范围存在盲区等。现有传感器中三维深度摄像头是一个较好的选择，具有获取环境精度高，但是存在感应盲区的问题。目前的三维深度摄像机的成像原理大致分为两种:一种是通过结构光获取深度，红外激光发射相对随机但又固定的斑点图案，这些光斑打在物体上后，因为与摄像头距离不同，被摄像头捕捉到的位置也不尽相同，然后计算拍到的图案的斑点与标定的标准图案在不同位置的位移；另一种是TOF (Time Of Flight)光学测距，计算光线飞行的时间，首先让装置发出脉冲光，并且在发射处接收目标物的反射光，即由测量时间差算出目标物的距离。
[0003]三维深度摄像机获取的数据精确，但是由于其设备自身精度问题，在现有的避障方法中还未有用三维深度摄像机做三维避障的方法。因为三维深度摄像机存在近距离感知盲区，无法测量微小的位移或微小的时间变化，使其无法获取过近的物体的数据当障碍物处于盲区内将无法安全避障，比如kinect —代三维深度摄像机的近距离感知环境的范围为0.4m至3.5m，在Om至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]当三维数据点个数为O时，判定三维数据点的个数为O的角度为障碍物存在的角度。
[0033]从上述描述可知，由于障碍物遮挡了三维深度摄像机获取地面数据，导致有障碍物的区域无法获取任何数据，表现为最下面的N行数据即地面部分出现一块空白，因此通过对比当前地面数据与无障碍物情况下地面数据，从而根据地面数据的三维数据点个数判断有无障碍物，没有三维数据点则说明有障碍物。
[0034]进一步的，所述地面数据和空中数据为三维数据。
[0035]请参照图2，
[0036]—种基于三维深度摄像机的近距离避障系统，包括:三维深度摄像机1、上位机3、下位机4、通信装置2以及移动装置，所述移动装置在地面上移动；
[0037]所述三维深度摄像机I安装于移动装置上，用于获取移动装置前方的深度图像，所述深度图像包括地面数据和空中数据；并将所述深度图像通过通信装置2发送给上位机3 ；
[0038]所述上位机3用于检测到移动装置前方的深度图像中地面存在障碍物时，计算当前位置与障碍物的角度和距离，并根据计算出的角度和距离改变移动装置的移动路线，并向下位机4发送改变移动装置移动路线的控制命令；检测到移动装置前方部分或全部地面数据无法获取时，判定无数据的地