视觉扫地机器人及建立场景地图的方法技术

本发明专利技术揭示了一种视觉扫地机器人以及建立地图的方法，其中建立地图方法是：扫地机器人采集图片，在建立地图中将图片中运动的物体忽略，不建立在地图里。该发明专利技术使建立的场景地图更加准确。

Visual sweeping robot and method of establishing scene map

The invention discloses a visual sweeping robot and a method of building a map, in which the method of building a map is to collect images from a sweeping robot, ignore the objects moving in the picture and not on the map. The invention makes the set of scene map more accurate.

【技术实现步骤摘要】
视觉扫地机器人及建立场景地图的方法
本专利技术涉及到扫地机器人领域，特别是涉及到一种视觉扫地机器人及建立场景地图的方法。
技术介绍
扫地机器人在清扫环境中进行定位建立场景地图时，一般假设环境是静态的，通过获取环境中静态信息来匹配计算得出当前姿态，而当环境中出现不断运动的动态物体时，例如在家里走动的人或宠物，匹配得出的姿态就会有较大误差。而且，在建图时，如果扫地机器人前方存在移动的物体，也会将此物体作为地图点标记在地图上，这样对扫地机器人的路径规则也会造成比较大的影响。
技术实现思路
本专利技术的主要目的为提供一种扫地机器人建立场景地图的方法，该方法建立的场景地图中没有运动的物体。本专利技术提出一种扫地机器人建立场景地图的方法，包括步骤：采集图片；判定所述图片中静止的物体所对应的区域，标记为有效区域；根据所述图片中有效区域建立场景地图。进一步地，所述判定所述图片中静止的物体所对应的区域，标记为有效区域的步骤包括：采用光流法提取所述图片中的运动物体；将所述运动物体在所述图片对应的区域中忽略，得到图片中剩余的区域为静止的物体所对应的区域，形成所述有效区域。进一步地，所述根据所述图片中有效区域建立场景地图的步骤包括：利用摄像头的内参结合所述静止的物体在所述图片中的位置计算所述静止的物体在场景地图中的位置；根据所述静止的物体在场景地图中的位置建立场景地图。进一步地，所述利用摄像头的内参结合所述静止的物体在所述图片中的位置计算所述静止的物体在场景地图中的位置的步骤包括：获取摄像头在所述场景地图中的位置；根据摄像头的内参，计算出所述静止的物体相对所述摄像头的位置；根据预设公式，计算得出所述静止的物体在所述场景地图中的位置。进一步地，所述摄像头的内参包括所述摄像头的焦距和光圈中心。进一步地，所述根据所述图片中有效区域建立场景地图的步骤包括：根据所述图片，建立三维坐标体系；获取所述静止的物体在所述三维坐标体系中的坐标，并在所述三维坐标体系中标记，形成所述场景地图；所述计算出所述静止的物体相对所述摄像头的位置的步骤包括：根据指定公式计算出在三维坐标体系中，所述静止的物体相对所述摄像头的坐标[x,y,z]，所述指定公式为：z＝dx＝(u-cx)·z/fxy＝(v-cy)·z/fy其中，fx、fy指摄像头在x,y两个轴上的焦距，cx、cy指像头的光圈中心，[u,v,d]为图片中的像素坐标。进一步地，所述根据预设公式，计算得出所述静止的物体在所述空间场景地图中位置的步骤包括：用所述静止的物体相对所述摄像头的坐标[x,y,z]加上所述摄像头在所述三维体系中的坐标，得到所述静止的物体在所述空间场景地图中位置。本专利技术还提出一种视觉扫地机器人，包括：视觉系统，用于采集清扫过程中拍摄的图片；判定系统，用于判定所述图片中静止的物体所对应的区域，标记为有效区域；地图系统，根据判定系统标记的有效区域建立场景地图。进一步地，所述判定系统包括：光流模块，用于采用光流法提取所述图片中的运动物体；忽略模块，用于将所述运动物体在所述图片对应的区域中忽略，得到图片中剩余的区域为静止的物体所对应的区域，形成所述有效区域。进一步地，所述地图系统包括：内参模块，用于利用摄像头的内参结合所述静止的物体在所述图片中的位置计算所述静止的物体在场景地图中的位置；建立模块，用于根据所述静止的物体在场景地图中的位置建立场景地图。进一步地，所述内参模块包括：位置单元，用于获取摄像头在所述场景地图中的位置；第一计算单元，用于根据摄像头的内参，计算出所述静止的物体相对所述摄像头的位置；第二计算单元，用于根据预设公式，计算得出所述静止的物体在所述场景地图中的位置。进一步地，所述摄像头的内参包括所述摄像头的焦距和光圈中心。进一步地，所述地图系统包括：坐标体系模块，用于根据所述图片，建立三维坐标体系；标记模块，用于获取所述静止的物体在所述三维坐标体系中的坐标，并在所述三维坐标体系中标记，形成所述场景地图；所述第一计算单元包括：公式子单元，用于根据指定公式计算出在三维坐标体系中，所述静止的物体相对所述摄像头的坐标[x,y,z]，所述指定公式为：z＝dx＝(u-cx)·z/fxy＝(v-cy)·z/fy其中，fx、fy指摄像头在x,y两个轴上的焦距，cx、cy指像头的光圈中心，[u,v,d]为图片中的像素坐标。进一步地，所述第二计算单元包括：相加子单元，用于用所述静止的物体相对所述摄像头的坐标[x,y,z]加上所述摄像头在所述三维体系中的坐标，得到所述静止的物体在所述空间场景地图中位置。与现有技术相比，本专利技术的视觉扫地机器人建立场景地图，将清扫环境中运动的物体不建立在场景地图中，使建立的场景地图更加准确，使用户在使用时避免将运动的家人或宠物建立在场景地图中，为后续的规划清扫路径提供更高效准确的路径规则。附图说明图1是本专利技术一实施例的视觉扫地机器人建立地图的方法的步骤示意图；图2本是专利技术一实施例的视觉扫地机器人建立地图的方法的步骤示意图；图3是本专利技术一实施例的视觉扫地机器人建立地图的方法的步骤示意图；图4是本专利技术一实施例的视觉扫地机器人建立地图的方法的步骤示意图；图5是本专利技术一实施例的视觉扫地机器人的结构示意图；图6是本专利技术一实施例的视觉扫地机器人的结构示意图；图7是本专利技术一实施例的视觉扫地机器人的结构示意图；图8是本专利技术一实施例的视觉扫地机器人的结构示意图。本专利技术目的的实现、功能特点及优点将结合实施例，参照附图做进一步说明。具体实施方式应当理解，此处所描述的具体实施例仅仅用以解释本专利技术，并不用于限定本专利技术。参照图1，提出本专利技术一实施例的视觉扫地机器人建立场景地图的方法，包括步骤：S1、采集图片；S2、判定所述图片中静止的物体所对应的区域，标记为有效区域；S3、根据所述图片中有效区域建立场景地图。本实施例中，视觉扫地机器人的视觉系统，可以进行拍照。扫地机器人在清扫时，视觉系统拍照，并根据拍摄的照片建立场景地图，在地图中，清扫环境中的各物体都会在地图中体现。例如清扫环境是用户的房子，房子里的桌子、椅子、电视等各种物体均会被视觉系统拍摄，然后利用视觉系统判断图中的物体是否移动，若物体是移动状态，则判定物体不是属于固定的环境，获取该物体的外形轮廓，将该外形轮廓从图片中剔除掉，判定运动的物体是无效区域，判定静止的物体的外形轮廓对应的区域是有效区域，在建立场景地图时，只获取图片中有效区域的部分。判定图片中静止的物体所对应的区域为有效区域的方法，可以是视觉系统分别采集两张图片，将两张图片进行对比，发现物体在图片中位置不一样，则判定物体为运动的物体。参照图2，进一步的，所述判定所述图片中静止的物体所对应的区域为有效区域的步骤包括：S21、采用光流法提取所述图片中的运动物体；S22、将所述运动物体在所述图片对应的区域中忽略，得到图片中剩余的区域为静止的物体所对应的区域，形成所述有效区域。本实施例中，光流法是给图片中的每个像素点赋予一个速度矢量，形成一个运动矢量场。扫地机器人根据拍摄的图像中各个像素点的速度矢量特征，可以对图像进行动态分析。如果图像中没有运动目标，则光流矢量在整个图像区域是连续变化的。当图像中有运动物体时，目标和背景存在着相对运动。运动物体所形成的速度矢量必然和背景的速度矢量有所不同，如此便可本文档来自技高网...

【技术保护点】
一种视觉扫地机器人建立场景地图的方法，其特征在于，包括步骤：采集图片；判定所述图片中静止的物体所对应的区域，标记为有效区域；根据所述图片中有效区域建立场景地图。

【技术特征摘要】
1.一种视觉扫地机器人建立场景地图的方法，其特征在于，包括步骤：采集图片；判定所述图片中静止的物体所对应的区域，标记为有效区域；根据所述图片中有效区域建立场景地图。2.如权利要求1所述的视觉扫地机器人建立场景地图的方法，其特征在于，所述判定所述图片中静止的物体所对应的区域，标记为有效区域的步骤包括：采用光流法提取所述图片中的运动物体；将所述运动物体在所述图片对应的区域中忽略，得到图片中剩余的区域为静止的物体所对应的区域，形成所述有效区域。3.如权利要求1所述的视觉扫地机器人建立场景地图的方法，其特征在于，所述根据所述图片中有效区域建立场景地图的步骤包括：利用摄像头的内参，结合所述静止的物体在所述图片中的位置计算所述静止的物体在场景地图中的位置；根据所述静止的物体在场景地图中的位置建立场景地图。4.如权利要求3所述的视觉扫地机器人建立场景地图的方法，其特征在于，所述利用摄像头的内参结合所述静止的物体在所述图片中的位置计算所述静止的物体在场景地图中的位置的步骤包括：获取摄像头在所述场景地图中的位置；根据摄像头的内参，计算出所述静止的物体相对所述摄像头的位置；根据预设公式，计算得出所述静止的物体在所述场景地图中的位置。5.如权利要求4所述的视觉扫地机器人建立场景地图的方法，其特征在于，所述根据所述图片中有效区域建立场景地图的步骤包括：根据所述图片，建立三维坐标体系；获取所述静止的物体在所述三维坐标体系中的坐标，并在所述三维坐标体系中标记，形成所述场景地图；所述计算出所述静止的物体相对所述摄像头的位置的步骤包括：根据指定公式计算出在三维坐标体系中，所述静止的物体相对所述摄像头的坐标[x,y,z]，所述指定公式为：z＝dx＝(u-cx)·z/fxy＝(v-cy)·z/fy其中，fx、fy指摄像头在x,y两个轴上的焦距，cx...

【专利技术属性】
技术研发人员：王声平，张立新，周毕兴，
申请(专利权)人：深圳市沃特沃德股份有限公司，
类型：发明
国别省市：广东,44