CN109373992A - 基于发光设备的地图纠正方法及装置 - Google Patents
基于发光设备的地图纠正方法及装置 Download PDFInfo
- Publication number
- CN109373992A CN109373992A CN201811149323.1A CN201811149323A CN109373992A CN 109373992 A CN109373992 A CN 109373992A CN 201811149323 A CN201811149323 A CN 201811149323A CN 109373992 A CN109373992 A CN 109373992A
- Authority
- CN
- China
- Prior art keywords
- map
- pixel
- pixel position
- angle
- ccd
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/50—Depth or shape recovery
- G06T7/55—Depth or shape recovery from multiple images
- G06T7/579—Depth or shape recovery from multiple images from motion
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
- G01C15/002—Active optical surveying means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/246—Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04N—PICTORIAL COMMUNICATION, e.g. TELEVISION
- H04N23/00—Cameras or camera modules comprising electronic image sensors; Control thereof
- H04N23/56—Cameras or camera modules comprising electronic image sensors; Control thereof provided with illuminating means
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10141—Special mode during image acquisition
- G06T2207/10152—Varying illumination
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/20—Special algorithmic details
- G06T2207/20081—Training; Learning
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30204—Marker
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30244—Camera pose
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30248—Vehicle exterior or interior
- G06T2207/30252—Vehicle exterior; Vicinity of vehicle
- G06T2207/30261—Obstacle
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04N—PICTORIAL COMMUNICATION, e.g. TELEVISION
- H04N17/00—Diagnosis, testing or measuring for television systems or their details
- H04N17/002—Diagnosis, testing or measuring for television systems or their details for television cameras
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Automation & Control Theory (AREA)
- Multimedia (AREA)
- Signal Processing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Circuit Arrangement For Electric Light Sources In General (AREA)
Abstract
基于发光设备的地图纠正方法,包括:移动设备到地图第一位置R1时记录两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的位置A1和位置A2,以得到每一像素点对应的地图坐标系距离为(A2‑A1)/L;记录设备在R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,记录A1和A2间的夹角α1;需要对地图进行纠正时,移动设备到R1,记录两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到设备在地图坐标系的偏离距离L差=(A3‑A1)*(A2‑A1)/L;记录A3和A4间的夹角α2,从而得到设备在地图坐标系的偏离角度α差=α2‑α1;根据L差以及α差对构建的地图上的坐标值进行纠正。
Description
本申请为申请日:2016年8月19日,申请号:201680030046.5,发明名称:基于发光设备的地图构建方法、纠正方法及装置的分案申请。
技术领域
本发明涉及即时定位与地图构建领域,尤其涉及一种基于发光设备的地图纠正方法及装置。
背景技术
移动装置的定位和地图构建是机器人领域的热点研究问题。对于已知环境中的移动装置自主定位和已知机器人位置的地图创建已经有了实用的解决方法。然而,在很多环境中移动装置不能利用全局定位系统进行定位,而且事先获取移动装置工作环境的地图很困难,甚至是不可能的。这时移动装置需要在自身位置不确定的条件下,在完全未知环境中构建地图,同时利用地图进行自主定位和导航。这就是所谓的即时定位与地图构建(SLAM)。
在即时定位与地图构建(SLAM)中,移动装置利用自身携带的传感器识别未知环境中的特征标志,然后根据移动装置与特征标志之间的相对位置和编码器的读数估计移动装置和特征标志的全局坐标。
目前,现在的自动行走机器人或设备的定位技术中常见的有:
1)、GPS定位;GPS定位的基本原理是根据高速运动的卫星瞬间位置作为已知的起算数据,采用空间距离后方交会的方法,确定待测点的位置。
2)、条形码定位方式。要将按照一定规则编译出来的条形码转换成有意义的信息,需要经历扫描和译码两个过程。物体的颜色是由其反射光的类型决定的,白色物体能反射各种波长的可见光,黑色物体则吸收各种波长的可见光,所以当条形码扫描器光源发出的光在条形码上反射后,反射光照射到条码扫描器内部的光电转换器上,光电转换器根据强弱不同的反射光信号,转换成相应的电信号。根据原理的差异,扫描器可以分为光笔、CCD/CMOS、激光三种。电信号输出到条码扫描器的放大电路增强信号之后,再送到整形电路将模拟信号转换成数字信号。白条、黑条的宽度不同,相应的电信号持续时间长短也不同。然后译码器通过测量脉冲数字电信号0,1的数目来判别条和空的数目。通过测量0,1信号持续的时间来判别条和空的宽度。此时所得到的数据仍然是杂乱无章的,要知道条形码所包含的信息,则需根据对应的编码规则(例如:EAN-8码),将条形符号换成相应的数字、字符信息。最后,由计算机系统进行数据处理与管理,物品的详细信息便被识别了。
以上各定位技术在自动行走机器人或自动行走设备实现过程中相对复杂,各有不同缺点:
1.GPS定位由于信号问题在室内不实用。
2.条码定位方式,因条码容易受污染而照成无法读取使用场合有限制。
室内环境中的移动机器人定位导航技术具有定位精度要求高、环境复杂的特点,以上这些方法都不适用。
发明内容
本发明实施例的目的是提供一种基于发光设备的地图构建方法、纠正方法及装置,能有效构建精度高的地图。
本发明实施例提供了一种基于发光设备的地图构建方法,适用于对待定位区域进行实时地图构建,所述待定位区域上方设有发光设备;包括步骤:
以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域,在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
作为上述方案的改进,所述发光设备的数量为两个及以上,且每一个发光设备对应设置在所述待定位区域的上方的特定位置上,每一所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息;所述方法还包括步骤:
在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时的其他发光设备位置的坐标值,并记录其他标志信息及对应的坐标值。
作为上述方案的改进,所述唯一编码信息可通过以下任一或组合方式来表示:
发光设备发出光源的数量;
发光设备发出光源组成的特定形状;
发光设备发出光源在一定时间内开启关闭的次数;
发光设备发出光源在一定时间内开启关闭的时间;或
发光设备发出不同颜色光线组合。
作为上述方案的改进,每一个所述发光设备直接发射出来的标志信息还包括用于区别可进入区域/禁止进入区域的区域编码信息,直接发射出带有禁止进入区域的区域编码信息的发光设备所在的分界线后的特定区域限定为禁止进入区域,所述区域编码信息通过同一种信息代表可进入区域,并通过另一种信息代表禁止进入区域,所述方法还包括步骤:
当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进。
作为上述方案的改进,在完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图时,还基于每一所述标志信息中的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
作为上述方案的改进,每一个所述发光设备直接发射出来的标志信息中还包括用于限定运动区域的区域编码信息;
当所述可移动电子设备获取到用于限定运动区域的区域编码信息时,控制所述可移动电子设备只在所述限定运动区域内移动。
作为上述方案的改进,还包括:
标定过程:将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正过程:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
作为上述方案的改进,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
作为上述方案的改进,所述可移动电子设备为机器人。
作为上述方案的改进,所述方法适用于对室内的待定位区域进行实时地图构建;或/和所述发光设备适于被设置在墙壁、天花板或者门框上。
本发明实施例还提供了一种基于发光设备的地图纠正方法,包括:
标定步骤:将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正步骤:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
本发明实施例还提供了一种基于发光设备的地图纠正方法,包括:
将可移动设备移动到通过初始标定得到的参考坐标点上,记录任两个发光设备直接发射出来的光点标志中心到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及第三像素点位置A3与初始标定的所对应的第一像素点位置A1的像素差,得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*L’;
记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,基于初始标定记录的第一像素点位置A1和第二像素点位置A2之间的夹角α1,得到可移动设备在地图坐标系的偏离角度α差=α2-α1;
根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
本发明实施例还提供了一种地图构建装置,适用于对待定位区域进行实时地图构建,所述待定位区域上方设有发光设备,所述地图构建装置为可移动设备,所述可移动设备包括:
摄像头,用于采集发光设备直接发射出来的光点标志;
坐标系构建及记录单元,用于在可移动电子设备初次沿一定的运动轨迹移动时,使所述摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
编码器,用于在所述可移动电子设备以所述坐标原点作为起始点移动并遍历整个待定位区域的过程中,基于陀螺仪实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离;
障碍物检测部件,用于检测障碍物;
第一计算单元,用于每当所述障碍物检测部件检测到障碍物时,基于所述编码器得到的相对所述起始点的移动方向和移动距离,计算每一所述障碍物位置的坐标值,并将计算到的坐标值发送给所述坐标系构建及记录单元;
地图构建单元,基于所述坐标系构建及记录单元记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
本发明实施例还提供了一种基于发光设备的地图纠正装置,包括:
标定单元,用于将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正单元,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
本发明实施例还提供了一种基于发光设备的地图纠正装置,包括:
偏离距离计算单元,用于将可移动设备移动到通过初始标定得到的参考坐标点上,记录任两个发光设备直接发射出来的光点标志中心到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及第三像素点位置A3与初始标定的所对应的第一像素点位置A1的像素差,得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*L’;
偏离角度计算单元,用于记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,基于初始标定记录的第一像素点位置A1和第二像素点位置A2之间的夹角α1,得到可移动设备在地图坐标系的偏离角度α差=α2-α1;
纠正单元,用于根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
与现有技术相比,本发明公开的一种基于发光设备的地图构建方法、纠正方法及装置,通过在待定位区域中设置至少一个发光设备,并基于可移动电子设备初次移动时摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;然后所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域,在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。因此,本发明只需要一个或以上的发光设备(例如LED光源、激光光源或红外光源)即可实现待定位区域的定位及地图构建,而且方法简单,精确度高,具有成本低、操作简单且有效的技术效果。另外,在构建地图后,能够利用摄像头对发光设备的识别对构建的地图进行纠正,防止因为可移动设备上的陀螺仪发生漂移或者轮子打滑等因素造成的地图误差。
附图说明
图1是本发明实施例1中一种基于发光设备的地图构建方法的流程示意图。
图2是本发明实施例2中一种基于发光设备的地图构建方法的流程示意图。
图3是本发明实施例3中一种基于发光设备的地图构建方法的流程示意图。
图4是本发明实施例4中一种基于发光设备的地图构建方法的流程示意图。
图5是本发明实施例5中一种基于发光设备的地图构建装置的结构框图。
图6是本发明实施例6中一种基于发光设备的地图构建装置的结构框图。
图7是本发明实施例7中一种基于发光设备的地图构建装置的结构框图。
图8是本发明实施例8中一种基于发光设备的地图构建装置的结构框图。
图9是本发明实施例9中一种基于发光设备的地图纠正方法的流程示意图。
图10是本发明实施例10中一种基于发光设备的地图纠正方法的流程示意图。
图11是本发明实施例11中一种基于发光设备的地图纠正装置的结构框图。
图12是本发明实施例12中一种基于发光设备的地图纠正装置的结构框图。
图13显示了对构建的地图进行纠正的过程。
图14显示了采用多于两个发光设备同时射入到CCD/CMOS的光点中心来进行距离和角度的偏差的纠正的原理。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
参见图1,是本发明实施例1提供的一种基于发光设备的地图构建方法的流程示意图。该基于发光设备的地图构建方法适用于利用可移动电子设备对设有至少一个发光设备的待定位区域进行实时地图构建,该可移动电子设备可为例如:机器人。
本实施例的基于发光设备的地图构建方法包括步骤:
S11、以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
S12、以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域;
S13、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
S14、完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
在步骤S11中,在待定位及地图构建的区域的至少一个特定位置/任意位置放置一个发光设备(例如LED光源、激光光源或红外光源)后,需要对该整个区域进行定位和构建地图,则需要通过可移动电子设备遍历整个区域才能获得区域中的相关信息。在第一次遍历开始时,可移动电子设备上的摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点时,将发光设备的位置(也即,可移动电子设备将此时的位置)作为由X轴和Y轴构成的坐标系中的坐标原点,并记录所述第一个所述标志信息及对应的坐标值。可以理解的,这里提及的“对应的坐标值”是指第一发光设备的位置的坐标值,也就是可移动电子设备当前的位置的坐标值。
可以理解的,为了方便计算和构图,将获取到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时,可移动设备的位置作为由X轴和Y轴构成的坐标系的坐标原点。但是,所述位置并不局限于只能作为由X轴和Y轴构成的坐标系的坐标原点,也可以是标记为其他参照点,具备参考作用即可,以方便记录其他点的信息。
其中,在本实施例中,所述至少一个发光设备对应设置在所述待定位区域的特定位置上,所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息,而所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合。
可以理解的,标志信息的构成是有多种方式的,具体示需要定位的待定位区域的环境需要标志数量来决定采用哪个方式更方便。在本实施例中,可移动电子设备通过摄像头来读取标志信息。
在步骤S12~S13中,当确定以获得第一个标志的位置为坐标原点时,将所述坐标原点作为运动的起始点移动所述可移动电子设备以遍历整个待定位区域。并且在所述可移动电子设备从所述起始点开始移动的同时,启动实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离(例如,机器人的驱动轮轴上安装的编码器基于陀螺仪来实时记录机器人所移动路径以及相对位置和角度,从而能够通过计算获得可移动电子设备相对所述起始点的位置(包括距离和方向),其中,所述陀螺仪用于实时记录角度以及加速度)。在遍历过程中,可通过以下方式来计算所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值:
方式一:利用碰撞传感器来感应障碍物,当碰撞传感器感测碰到障碍物时,将所述可移动电子设备当前的坐标值作为所述障碍物位置的坐标值;
方式二:利用激光传感器/红外传感器来探测障碍物,当激光传感器/红外传感器来探测到障碍物时,根据激光/红外距离计算原理计算出障碍物相对当前所述可移动电子设备的位置,从而计算出所述障碍物位置的坐标值。
另外,本实施例还增设了碰撞策略,即,在所述可移动电子设备的遍历过程中检测到障碍物检测到障碍物时,根据预设的碰撞策略,使所述可移动电子设备绕开所述障碍物而继续前进。
在本发明的一个优选实施例中,所述预定的碰撞策略包括:当可移动电子设备通过(例如,障碍物检测部件)感测到发生碰撞时,所述可移动电子设备将进行智能分析以确定进一步的移动方式。例如,所述可移动电子设备可以根据待定位区域的具体环境格局选择后退大于0且小于20厘米并且向右或左旋转1-10°。当所述可移动电子设备处于狭小空间中时,所述可移动电子设备可以选择后退大于0且小于2厘米。更进一步地,在连续3次旋转1°后的再次碰撞点均在一个平面时,所述可移动电子设备则选择旋转更大的角度,例如旋转角度2°甚至10°。
可以理解的,除了这里公开的碰撞策略外,本实施例的碰撞策略还可以采用其他方式,并不局限于此。
因此,通过预设的碰撞策略,继续移动所述可移动电子设备以获取其他标志和障碍物的坐标值,直至遍历完整个待定位区域时,才完成一次遍历。可以理解的,所述可移动电子设备完成一次遍历后,记录该待定位区域的全部特征信息(包括标志的位置及每一个障碍物位置的位置信息)。
在所述步骤S14中,待所述可移动电子设备完成一次遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值来构建地图。记录的信息越多,所构建的地图越丰富和详细。例如,由于可移动电子设备检测到障碍物时,会将障碍物的坐标值记录下来,当可移动电子设备置于室内环境遍历完整个房间后,便可以将所有障碍物的坐标连续记录下来,外围的同时围成一个圈的障碍物则可以认为是墙壁,这样,就将整个房间的无障碍区域,有障碍区域,墙壁区分开,这就构建了整个房间的地图。
可以理解的,所构建的地图为2D地图,所述可移动电子设备(例如,机器人)可以按照构建完成后的地图进行导航。
可见,本实施例的基于发光设备的地图构建方法只需要一个或以上的发光设备直接发射出相应的标志即可实现待定位区域的定位及地图构建,方法简单,具有精度高、成本低、操作简单且有效的技术效果。
参考图2,是本发明实施例2提供的一种基于发光设备的地图构建方法的流程示意图。该方法适用于利用可移动电子设备对设有两个或以上发光设备的待定位区域进行实时地图构建。其中,每一个发光设备对应设置在所述待定位区域的特定位置上,每一所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息,所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合。该可移动电子设备可为,例如:机器人。
本实施例的基于发光设备的地图构建方法包括步骤:
S21、以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
S22、以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域;
S23、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
S24、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时的其他发光设备位置的坐标值,并记录其他标志信息及对应的坐标值;
S25、完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
可以理解的,本实施例的步骤S21~S23及S25与图1所示的步骤S11~S13及S14基本一致,在此不再赘述。
与实施例1不同的是,由于本实施例的方法适用于对设有两个或以上发光设备的待定位区域进行地位,且每一个发光设备对应设置在所述待定位区域的特定位置上,每一所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息,因此,在所述可移动电子设备的遍历过程中,除了要计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值外,还要计算并记录所述可移动电子设备每一次获取到的除所述第一个发光设备直接发射出来的标志信息外的其他标志信息以及相应的坐标值,即步骤S24。
同样,以可移动电子设备上的摄像头所采集到的其他所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时,可移动电子设备当前的位置作为对应发光设备所处的位置,记录该位置的坐标值以及获取对应的标志信息。
可以理解的,该处所指的可移动电子设备获取到的标志信息中主要包含用于区别其绝对位置的唯一编码信息。例如,当将至少两个发光设备分别放置在待定位区域的不同特定位置(例如,房间1,房间2……)上时,需要通过所述发光设备直接发射出来的标志中的唯一编码信息来确定并区分该发光设备所处的特定位置(绝对位置),例如,该发光设备位于房间1还是房间2等。因此,通过获取每一个发光设备直接发射出来的标志中的唯一编码信息时,经过识别能够确定该发光设备所处的绝对位置。
关于标志的唯一编码信息的表示方式,可参考上述实施例1中的相关描述。
可以理解的,本实施例的基于发光设备的地图构建方法适用于对室内的待定位区域进行实时地图构建。在对室内环境进行定位时,优选在该室内的每一个房间的墙壁、天花板或者门框的左侧墙壁、右侧墙壁或顶壁上设置一个所述发光设备。
这样,基于记录的每一个标志信息及相应的坐标值以及每一个障碍物位置的坐标值完成地图构建后,所述可移动电子设备可以基于每一个标志中的唯一编码信息来实现绝对位置的导航和分辨。例如,需要机器人遍历一趟房间2的时候,可以基于放置在该房间2的门框的左侧墙壁、右侧墙壁或顶壁上的发光设备直接发射出来的标志中的唯一编码信息来确定房间2的绝对位置,并基于该发光设备位置在构建的地图上的相对坐标值(相对坐标原点的方向和距离),从而导航可移动电子设备到达该房间2。
另外,基于每一个标志中的唯一编码信息,还能使可移动设备(机器人)知道其“身在何处”。例如,对于清洁机器人,需要对室内的多个房间进行清洁时,这样,通过识别每一个房间对应的标志中的唯一编码信息,就能确定自身处于哪个房间,从而防止多次对同一个房间进行清洁,以减少重复工作。区分房间的主要目的是一间一间的房间清扫,这样效率会比较高。这样,对于机器人遍历来说会少走很多重复路线。
参考图3,是本发明实施例3提供的一种基于发光设备的地图构建方法的流程示意图。该方法适用于利用可移动电子设备对设有两个或以上发光设备的待定位区域进行实时地图构建。其中,每一个发光设备对应设置在所述待定位区域的特定位置上,每一所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息以及用于区别可进入区域/禁止进入区域的区域编码信息。其中,带有禁止进入区域的区域编码信息的标志将对应的发光设备所在的分界线后的特定区域限定为禁止进入区域。所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合;而所述区域编码信息可通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域。该可移动电子设备可为,例如:机器人。
本实施例的基于发光设备的地图构建方法包括步骤:
S31、以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
S32、基于获取的第一个所述标志中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进;
S33、以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域;
S34、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
S35、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时的其他发光设备位置的坐标值,并记录其他标志信息及对应的坐标值;
S36、当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进;
S37、完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图,并基于每一所述标志中的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
在每一个所述标志中,均包括所述唯一编码信息和所述区域编码信息,所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合;而所述区域编码信息可通过同一种信息代表可进入区域,并通过另一种信息代表禁止进入区域。
另外,作为本实施例的优选方案,每一个所述发光设备直接发射出来的标志信息中还包括用于限定运动区域的区域编码信息;
当所述可移动电子设备获取到用于限定运动区域的区域编码信息时,控制所述可移动电子设备只在所述限定运动区域内移动。
可见,本实施例在实施例2的基础上,还增加了一个效果,即解决了自动识别禁止进入区域问题(也称为虚拟墙)。在机器人识别禁止进入区域的解决问题上,传统方法主要是利用以下方式:
一种是irobot公司提出的采用红外线发射装置置于期望禁止进入区域分界线上,机器人检测到红外线以后就不会越过该界线。这种方法的不足是红外线发射装置需要安装电池,给用户带来不便,另外一方面,该装置放置在分界线附近,如果家里有宠物等碰到改装置,该装置会移动,失去作用。
另外一种方法是Neato公司提出的采用磁条做分界线的方法,该方法需要用户将磁条贴于禁止进入区域的分界线上,采用霍尔传感器感应来区分。该方法的不足之处在于磁条贴于地面影响地面美观,另外一方面,用户如果希望更换禁止进入区域,磁条贴于地面不方便拆装。
而本实施例通过将用于区别可进入区域/禁止进入区域的区域编码信息置于每一个发光设备直接发射出来的标志中,其中,带有禁止进入区域的区域编码信息的标志将对应的发光设备所在的分界线后的特定区域限定为禁止进入区域。这样,当可移动设备识别到标志中的区域编码信息后即可区分。在识别为禁止进入区域后,结合预设的避开策略,即可使所述可移动电子设备避开所述禁止进入区域而继续前进。另外,在遍历完成后,基于每一所述标志的区域编码信息,还可以在构建的地图上具体标示为可进入区域/禁止进入区域,以利于导航。
可以理解的,可以在可移动设备中预先设置标志不同的区域编码信息代表可进入区域/禁止进入区域的关系对照表,这样,当获取的每一个所述标志信息中的区域编码信息时,通过该对照表即可识别为可进入区域还是禁止进入区域。
其中,本实施例的预设的避开策略优选为:在识别出该区域为禁止进入区域时,使所述可移动电子设备后退P厘米并且向左/右旋转Q°后继续前进,其中,P不少于所述分界线的长度,45≤Q≤90。基于该预设的避开策略,基本上可以保证所述可移动电子设备能够避开所述禁止进入区域而继续前进。
另外,可通过以下方式来区分禁止进入区域和可进入区域之间的分界线:当可移动设备判断标志中的区域编码信息为禁止进入区域时,移动可移动设备在标签的左右两边寻找障碍物(墙壁)和无障碍区域,墙壁的延伸线就是禁止进入区域与可进入区域的分界线。
可以理解的,除了这里公开的避开策略外,本实施例的避开策略还可以采用其他方式,并不局限于此。
在利用本实施例的方法进行室内定位及地图构建时,优选在该室内的每一个房间墙壁、天花板或门框的左侧墙壁、右侧墙壁或顶壁上设置一个发光设备,由发光设备投影出相应的标志到门框上或天花板上。
可见,相比现有技术中的虚拟墙技术,本发明实施例通过将用于区别可进入区域/禁止进入区域的区域编码信息置于(例如,房间门框边的固定槽内的)每一个标志中,使得可移动设备获取并识别标志中的区域编码信息后,即可确定该区域能够进入。因此,本实施例的成本低,而且不影响整体美观,还容易更换。
参考图4,是本发明实施例4提供的一种基于发光设备的地图构建方法的流程示意图。通过机器人的驱动轮轴上安装的编码器来实时记录机器人相对所述起始点的移动方向和移动距离时,由于打滑、两驱动轮和地面接触点之间距离的不确定等原因,使得编码器的测算过程存在累积误差,另外,由于陀螺仪漂移也会对构建的地图造成偏差。因此,本实施例在前述实施例的基础上,对构建的地图进行纠正,防止因为可移动设备上的陀螺仪发生漂移或者轮子打滑等因素造成的地图误差,使得基于坐标值构建的地图更为精确。
具体的,本实施例在前述实施例1~实施例3的基础上构建得到地图后,增加对地图的纠正处理,具体包括:
S41、标定过程:将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
S42、纠正过程:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
其中,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
在本实施例中,可移动设备中设置两个坐标系,一个是待定位区域的地图构建坐标系,一个是可移动设备中的摄像头的CCD/CMOS坐标系。其中,CCD/CMOS坐标系是指发光设备直接发射出来的光点标志到CCD/CMOS上所在像素点位置而形成的,CCD/CMOS坐标系也包括X轴和Y轴。
利用本实施例对构建的地图进行纠正前,首先需要进行标定。例如,对于室内定位和地图构建来说,每家每户房子的层高不一样,这样发光设备投影标志在摄像头CCD/CMOS上X轴或者Y轴每偏离一个像素点,可移动设备对应在地图坐标系(即地面坐标系)上运动距离也会不一样,所以需要标定。
具体标定过程为,当可移动设备(例如,机器人)在运动过程中到达第一位置R1时摄像头检测到两个发光设备直接发射出来的两个光点标志中心投影到CCD/CMOS上,如图13所示的第一像素位置A1和第一像素位置A2。从而可以计算出第一像素位置A1和第一像素位置A2之间的像素差值。通过所述两个发光设备之间的地图坐标系上的距离除以像素点数就可以求出一个像素点对应了机器人在地面坐标系距离。同时,记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1(例如,相对水平面)。
在标定完成后,当机器人运行一段时间(例如20分钟)需要纠正已构建的地图时,机器人运动到参考坐标点所在的位置(即第一位置R1)。通过这一次在CCD/CMOS的两个像素位置中的任一个对应与上一次位置差可以知道偏离了多少个像素。通过多少个像素乘以标定时的距离便可以求出机器人在地面坐标系偏离了多少距离。
例如,以第一像素点位置A1作为参考点,将可移动设备移动到所述第一位置R1时,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的位置,如图13上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L。并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1。
这时,根据计算出来的所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正,从而得到纠正后的地图。
可以理解的,本实施例通过两个发光设备同时射入到CCD/CMOS的光点中心来进行距离和角度的偏差的纠正。例如,当发光设备为红色LED时,在CCD里面的投影有两个很明显的亮点,亮点在CCD里面可能占几十或者几百个像素点,本实施例以这几十或者几百个像素点的中间的点作为光点中心。
另外,本实施例也可采用多于两个发光设备同时射入到CCD/CMOS的光点中心来进行距离和角度的偏差的纠正。参考图14,假设预先知道各个边(x、y、z)的顶点(a、b、c)对应关系(顶点是亮点的中心点)。如果是三个发光亮点中心组成一个三角形,要纠正坐标或者角度,需要知道只要三条边的长度不一样,在下一次纠正的时候,就可以判断出亮点的对应关系。其中,a、b、c任意一个点都可以作为纠正坐标的点,x、y、z三条线段都可以作为纠正角度的线段。
参见图5,是本发明实施例1提供的一种基于发光设备的地图构建装置的结构框图。该地图构建装置为可移动设备/安装在可移动设备上,适用于对设有至少一个发光设备的待定位区域进行实时地图构建,该可移动电子设备可为例如:机器人。
所述地图构建装置包括:
摄像头51,用于采集发光设备直接发射出来的光点标志;
坐标系构建及记录单元52,用于在可移动电子设备初次沿一定的运动轨迹移动时,使所述摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
编码器53,用于在所述可移动电子设备以所述坐标原点作为起始点移动并遍历整个待定位区域的过程中,基于陀螺仪实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离;
障碍物检测部件54,用于检测障碍物;
第一计算单元55,用于每当所述障碍物检测部件54检测到障碍物时,基于所述编码器53得到的相对所述起始点的移动方向和移动距离,计算每一所述障碍物位置的坐标值,并将计算到的坐标值发送给所述坐标系构建及记录单元;
地图构建单元56,基于所述坐标系构建及记录单元52记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
关于本实施例的地图构建装置的工作原理和过程,可以参考实施例1,在此不再赘述。
其中,所述障碍物检测部件54可包括碰撞传感器/激光传感器/红外传感器:
利用碰撞传感器来感应障碍物,当碰撞传感器感测碰到障碍物时,将所述可移动电子设备当前的坐标值作为所述障碍物位置的坐标值;
所述碰撞传感器部件用于感测所述可移动电子设备与外部环境的碰撞事件。所述碰撞传感器部件包括但不限于偏心锤式传感器、滚球式碰撞传感器、滚轴式膨胀传感器、水银开关式碰撞传感器、有压阻效应式碰撞传感器、压电效应式碰撞传感器和微动开关等。或
利用激光传感器/红外传感器来探测障碍物,当激光传感器/红外传感器来探测到障碍物时,根据激光/红外距离计算原理计算出障碍物相对当前所述可移动电子设备的位置,从而计算出所述障碍物位置的坐标值。
在本实施例中,优选的,所述可移动设备还包括:碰撞策略单元,用于在所述可移动电子设备的遍历过程中检测到障碍物时,根据预设的碰撞策略,使所述可移动电子设备绕开所述障碍物而继续前进。
有关该碰撞策略单元的工作原理和方式可参考实施例1的相关描述。
在本发明的另一优选实施例中,参考图6,该实施例6的地图构建装置为可移动设备/安装在可移动设备上,适用于对设有两个或以上发光设备的待定位区域进行实时地图构建。其中,每一个发光设备对应设置在所述待定位区域的特定位置上,每一所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息,所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合。该可移动电子设备可为,例如:机器人。
所述地图构建装置包括:
摄像头61,用于采集发光设备直接发射出来的标志;
坐标系构建及记录单元62,用于在可移动电子设备初次沿一定的运动轨迹移动时,使所述摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
编码器63,用于在所述可移动电子设备以所述坐标原点作为起始点移动并遍历整个待定位区域的过程中,基于陀螺仪实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离;
障碍物检测部件64,用于检测障碍物;
第一计算单元65,用于每当所述障碍物检测部件64检测到障碍物时,基于所述编码器53得到的相对所述起始点的移动方向和移动距离,计算每一所述障碍物位置的坐标值,并将计算到的坐标值发送给所述坐标系构建及记录单元;
第二计算单元66,用于在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时的其他发光设备位置的坐标值,并将其他标志信息及对应的坐标值发送给所述坐标系构建及记录单元62;
地图构建单元67,基于所述坐标系构建及记录单元62记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
本实施例的地图构建装置的工作原理和过程可参考上述实施例2的相关描述,在此不再赘述。
参考图7,是本发明实施例7提供的一种基于发光设备的地图构建装置的结构框图。该装置为可移动设备/安装在可移动设备上,适用于对设有两个或以上发光设备的待定位区域进行实时地图构建。其中,每一个发光设备对应设置在所述待定位区域的特定位置上,每一所述发光设备直接发射出来的标志信息包括用于区别其绝对位置的唯一编码信息以及用于区别可进入区域/禁止进入区域的区域编码信息。其中,带有禁止进入区域的区域编码信息的标志将对应的发光设备所在的分界线后的特定区域限定为禁止进入区域。所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合;而所述区域编码信息可通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域。该可移动电子设备可为,例如:机器人。
所述地图构建装置包括:
摄像头71,用于采集发光设备直接发射出来的标志;
坐标系构建及记录单元72,用于在可移动电子设备初次沿一定的运动轨迹移动时,使所述摄像头所采集到的第一个所述发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
编码器73,用于在所述可移动电子设备以所述坐标原点作为起始点移动并遍历整个待定位区域的过程中,基于陀螺仪实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离;
障碍物检测部件74,用于检测障碍物;
第一计算单元75,用于每当所述障碍物检测部件74检测到障碍物时,基于所述编码器53得到的相对所述起始点的移动方向和移动距离,计算每一所述障碍物位置的坐标值,并将计算到的坐标值发送给所述坐标系构建及记录单元;
第二计算单元76,用于在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他发光设备直接发射出来的光点标志中心与CCD/CMOS中心点重合时的其他发光设备位置的坐标值,并将其他标志信息及对应的坐标值发送给所述坐标系构建及记录单元72;
区域识别单元77,用于当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域。可以理解的,可以在区域识别单元77中预先设置标志不同的区域编码信息代表可进入区域/禁止进入区域的关系对照表,这样,当获取的每一个标志中的区域编码信息时,通过该对照表即可识别为可进入区域还是禁止进入区域。
避开策略单元78,若所述区域识别单元77识别区域编码信息为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进;
地图构建单元79,基于所述坐标系构建及记录单元72记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图,并基于每一所述标志的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
在每一个所述标志中,均包括所述唯一编码信息和所述区域编码信息,所述唯一编码信息可通过以下任一或组合方式来表示:发光设备发出光源的数量;发光设备发出光源组成的特定形状;发光设备发出光源在一定时间内开启关闭的次数;发光设备发出光源在一定时间内开启关闭的时间;或发光设备发出不同颜色光线组合;而所述区域编码信息可通过同一种信息代表可进入区域,并通过另一种信息代表禁止进入区域。
另外,作为本实施例的优选方案,每一个所述发光设备直接发射出来的标志信息中还包括用于限定运动区域的区域编码信息;当所述可移动电子设备获取到用于限定运动区域的区域编码信息时,控制所述可移动电子设备只在所述限定运动区域内移动。
本实施例的地图构建装置有效解决了现有技术中的自动识别禁止进入区域问题(也称为虚拟墙)问题,其具体实现过程和原理请参考上述实施例3的相关描述。
参考图8,是本发明实施例8提供的一种基于发光设备的地图构建装置的结构框图。该装置在实施例5~7中任一个地图构建装置的基础上,还包括:
标定单元81,用于将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正单元82,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
其中,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
本实施例的地图构建装置的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
本发明实施例还公开了一种智能移动设备,包括移动装置以及如图5~图8所示的任意实施例的地图构建装置。该智能移动设备优选为机器人。
参考图9,图9是本发明实施例9中一种基于发光设备的地图纠正方法的流程示意图。该地图纠正方法包括步骤:
S91、标定步骤:将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
S92、纠正步骤:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
其中,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例1~实施例4中任一项所述的基于发光设备的地图构建方法构建得到。
本实施例的地图纠正方法的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
参考图10,图10是本发明实施例10中一种基于发光设备的地图纠正方法的流程示意图。该地图纠正方法包括步骤:
S101、将可移动设备移动到通过初始标定得到的参考坐标点上,记录任两个发光设备直接发射出来的光点标志中心到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及第三像素点位置A3与初始标定的所对应的第一像素点位置A1的像素差,得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*L’;
S102、记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,基于初始标定记录的第一像素点位置A1和第二像素点位置A2之间的夹角α1,得到可移动设备在地图坐标系的偏离角度α差=α2-α1;
S103、根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
其中,所述初始标定过程如下:
(1)将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2;
(2)计算每一像素点对应的地图坐标系距离L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;
(3)记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1。
其中,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例1~实施例4中任一项所述的基于发光设备的地图构建方法构建得到。
本实施例的地图纠正方法的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
参考图11,图11是本发明实施例11中一种基于发光设备的地图纠正装置的结构框图。该地图纠正装置包括:
标定单元111,用于将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正单元112,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
其中,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例5~实施例8中任一项所述的地图构建装置构建得到。
参考图12,图12是本发明实施例12中一种基于发光设备的地图纠正装置的结构框图。该地图纠正装置包括:
偏离距离计算单元121,用于将可移动设备移动到通过初始标定得到的参考坐标点上,记录任两个发光设备直接发射出来的光点标志中心到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及第三像素点位置A3与初始标定的所对应的第一像素点位置A1的像素差,得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*L’;
偏离角度计算单元122,用于记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,基于初始标定记录的第一像素点位置A1和第二像素点位置A2之间的夹角α1,得到可移动设备在地图坐标系的偏离角度α差=α2-α1;
纠正单元123,根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
其中,所述初始标定过程如下:
(1)将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2;
(2)计算每一像素点对应的地图坐标系距离L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;
(3)记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1。
其中,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例5~实施例8中任一项所述的地图构建装置构建得到。
本实施例的地图纠正方法的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
最后,还需要说明的是,上述一系列处理不仅包括以这里所述的顺序按时间序列执行的处理,而且包括并行或分别地、而不是按时间顺序执行的处理。通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到本发明可借助软件加必需的硬件平台的方式来实现,当然也可以全部通过软件来实施。基于这样的理解,本发明的技术方案对背景技术做出贡献的全部或者部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例或者实施例的某些部分所述的方法。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。
Claims (16)
1.一种基于发光设备的地图纠正方法,其特征在于,包括:
标定步骤:将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正步骤:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
2.如权利要求1所述的地图纠正方法,其特征在于,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
3.如权利要求1所述的地图纠正方法,其特征在于,所述可移动电子设备为机器人。
4.如权利要求1所述的地图纠正方法,其特征在于,所述发光设备为LED光源、激光光源或红外光源。
5.一种基于发光设备的地图纠正方法,其特征在于,包括:
将可移动设备移动到通过初始标定得到的参考坐标点上,记录任两个发光设备直接发射出来的光点标志中心到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及第三像素点位置A3与初始标定的所对应的第一像素点位置A1的像素差,得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*L’;
记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,基于初始标定记录的第一像素点位置A1和第二像素点位置A2之间的夹角α1,得到可移动设备在地图坐标系的偏离角度α差=α2-α1;
根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
6.如权利要求5所述的地图纠正方法,其特征在于,所述初始标定过程如下:
将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2;
计算每一像素点对应的地图坐标系距离L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;
记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1。
7.如权利要求5或6所述的地图纠正方法,其特征在于,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
8.如权利要求7所述的地图纠正方法,其特征在于,所述发光设备为LED光源、激光光源或红外光源。
9.一种基于发光设备的地图纠正装置,其特征在于,包括:
标定单元,用于将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1;
纠正单元,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第一位置R1,记录所述两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,从而得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*(A2-A1)/L;并记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,从而得到可移动设备在地图坐标系的偏离角度α差=α2-α1;并根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
10.如权利要求9所述的地图纠正装置,其特征在于,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
11.如权利要求9所述的地图构建装置,其特征在于,所述发光设备为LED光源、激光光源或红外光源。
12.如权利要求9所述的地图纠正装置,其特征在于,所述可移动电子设备为机器人。
13.一种基于发光设备的地图纠正装置,其特征在于,包括:
偏离距离计算单元,用于将可移动设备移动到通过初始标定得到的参考坐标点上,记录任两个发光设备直接发射出来的光点标志中心到CCD/CMOS上的第三像素点位置A3和第四像素点位置A4,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及第三像素点位置A3与初始标定的所对应的第一像素点位置A1的像素差,得到可移动设备在地图坐标系的偏离距离L差=(A3-A1)*L’;
偏离角度计算单元,用于记录第三像素点位置A3和第四像素点位置A4之间的夹角α2,基于初始标定记录的第一像素点位置A1和第二像素点位置A2之间的夹角α1,得到可移动设备在地图坐标系的偏离角度α差=α2-α1;
纠正单元,用于根据所述偏离距离L差以及偏离角度α差对构建的地图上的坐标值进行纠正。
14.如权利要求13所述的地图纠正装置,其特征在于,所述初始标定过程如下:
将可移动设备移动到地图的第一位置R1时记录任两个发光设备直接发射出来的光点标志中心直接发射到CCD/CMOS上的第一像素点位置A1和第二像素点位置A2;
计算每一像素点对应的地图坐标系距离L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量,L表示为所述两个发光设备之间的地图坐标系上的距离;
记录可移动设备在第一位置R1时地图坐标值以及两个发光设备对应的标志中心直接发射到CCD/CMOS上的两个像素坐标值,并记录第一像素点位置A1和第二像素点位置A2之间的夹角α1。
15.如权利要求13或14所述的地图纠正装置,其特征在于,所述角度α1和角度α2通过以下计算公式得到:
α1=arctan(y1/x1);
α2=arctan(y2/x2);
其中x1、y1分别为第一像素点位置A1和第二像素点位置A2之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为第三像素点位置A3和第四像素点位置A4之间构成的线段在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
16.如权利要求13所述的地图纠正装置,其特征在于,所述发光设备为LED光源、激光光源或红外光源。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811149323.1A CN109373992B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图纠正方法及装置 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811149323.1A CN109373992B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图纠正方法及装置 |
PCT/CN2016/095960 WO2018032488A1 (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图构建方法、纠正方法及装置 |
CN201680030046.5A CN108139213B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图构建方法、纠正方法及装置 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201680030046.5A Division CN108139213B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图构建方法、纠正方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109373992A true CN109373992A (zh) | 2019-02-22 |
CN109373992B CN109373992B (zh) | 2022-02-22 |
Family
ID=61197239
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201680030046.5A Active CN108139213B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图构建方法、纠正方法及装置 |
CN201811149323.1A Active CN109373992B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图纠正方法及装置 |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201680030046.5A Active CN108139213B (zh) | 2016-08-19 | 2016-08-19 | 基于发光设备的地图构建方法、纠正方法及装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20190164306A1 (zh) |
CN (2) | CN108139213B (zh) |
WO (1) | WO2018032488A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113268063A (zh) * | 2021-06-03 | 2021-08-17 | 北京京东乾石科技有限公司 | 机器人的控制方法、装置和非易失性计算机可读存储介质 |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109613472B (zh) * | 2018-12-26 | 2023-04-28 | 芜湖哈特机器人产业技术研究院有限公司 | 一种用于室内无轨导航的红外顶标及其识别方法 |
US11187538B2 (en) * | 2019-06-13 | 2021-11-30 | Dalian University Of Technology | Method for judging rotating characteristics of light sources based on summation calculation in visible light indoor positioning |
CN112484713A (zh) * | 2020-10-15 | 2021-03-12 | 珊口(深圳)智能科技有限公司 | 移动机器人的地图构建方法、导航方法及控制系统 |
CN112641383B (zh) * | 2020-12-17 | 2021-12-24 | 珠海一微半导体股份有限公司 | 基于斜坡结构的机器人脱卡控制方法、芯片及清洁机器人 |
CN112702693B (zh) * | 2020-12-23 | 2023-06-23 | 南京苏美达智能技术有限公司 | 一种自行走设备的地图构建方法及定位方法 |
CN113834488B (zh) * | 2021-11-25 | 2022-03-25 | 之江实验室 | 基于结构光阵列远程识别的机器人空间姿态解算方法 |
CN114136306B (zh) * | 2021-12-01 | 2024-05-07 | 浙江大学湖州研究院 | 一种可拓展的基于uwb和摄像头的相对定位的设备和方法 |
CN114485682B (zh) * | 2021-12-30 | 2023-06-27 | 武汉光庭信息技术股份有限公司 | 一种基于slam技术的定位方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102773862A (zh) * | 2012-07-31 | 2012-11-14 | 山东大学 | 用于室内移动机器人的快速精确定位系统及其工作方法 |
CN103325296A (zh) * | 2012-03-19 | 2013-09-25 | 联想(北京)有限公司 | 用于即时定位与地图构建的信息处理方法和设备 |
CN103383446A (zh) * | 2013-04-09 | 2013-11-06 | 北京半导体照明科技促进中心 | 基于可见光的室内定位方法、装置和系统以及光源 |
CN103439973A (zh) * | 2013-08-12 | 2013-12-11 | 桂林电子科技大学 | 自建地图家用清洁机器人及清洁方法 |
CN104406539A (zh) * | 2014-11-21 | 2015-03-11 | 浙江工业大学 | 全天候主动式全景感知装置及3d全景建模方法 |
CN105310604A (zh) * | 2014-07-30 | 2016-02-10 | Lg电子株式会社 | 机器人清洁系统以及控制机器人清洁器的方法 |
CN105607635A (zh) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制系统及全向自动导引车 |
US20160144505A1 (en) * | 2014-11-26 | 2016-05-26 | Irobot Corporation | Systems and Methods for Performing Occlusion Detection |
CN105785989A (zh) * | 2016-02-24 | 2016-07-20 | 中国科学院自动化研究所 | 利用行进中机器人标定分布式网络摄像机的系统和相关方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7689321B2 (en) * | 2004-02-13 | 2010-03-30 | Evolution Robotics, Inc. | Robust sensor fusion for mapping and localization in a simultaneous localization and mapping (SLAM) system |
CN103297486B (zh) * | 2012-03-05 | 2017-03-29 | 联想(北京)有限公司 | 即时定位与地图构建方法和设备 |
CN103323002B (zh) * | 2012-03-19 | 2016-04-27 | 联想(北京)有限公司 | 即时定位与地图构建方法和装置 |
US9519289B2 (en) * | 2014-11-26 | 2016-12-13 | Irobot Corporation | Systems and methods for performing simultaneous localization and mapping using machine vision systems |
CN105806337B (zh) * | 2014-12-30 | 2019-07-19 | Tcl集团股份有限公司 | 一种应用于室内机器人的定位方法和室内机器人 |
CN104754515B (zh) * | 2015-03-30 | 2019-03-26 | 北京云迹科技有限公司 | 混合定位辅助地图修正方法及系统 |
CN105258702B (zh) * | 2015-10-06 | 2019-05-07 | 深圳力子机器人有限公司 | 一种基于slam导航移动机器人的全局定位方法 |
CN107836013B (zh) * | 2016-03-09 | 2019-09-03 | 广州艾若博机器人科技有限公司 | 地图构建方法、纠正方法及装置 |
CN107346133B (zh) * | 2017-07-04 | 2020-12-04 | 武汉视览科技有限公司 | 一种室内移动机器人的自主建图方法和装置 |
-
2016
- 2016-08-19 CN CN201680030046.5A patent/CN108139213B/zh active Active
- 2016-08-19 WO PCT/CN2016/095960 patent/WO2018032488A1/zh active Application Filing
- 2016-08-19 CN CN201811149323.1A patent/CN109373992B/zh active Active
-
2019
- 2019-01-30 US US16/262,162 patent/US20190164306A1/en not_active Abandoned
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103325296A (zh) * | 2012-03-19 | 2013-09-25 | 联想(北京)有限公司 | 用于即时定位与地图构建的信息处理方法和设备 |
CN102773862A (zh) * | 2012-07-31 | 2012-11-14 | 山东大学 | 用于室内移动机器人的快速精确定位系统及其工作方法 |
CN103383446A (zh) * | 2013-04-09 | 2013-11-06 | 北京半导体照明科技促进中心 | 基于可见光的室内定位方法、装置和系统以及光源 |
CN103439973A (zh) * | 2013-08-12 | 2013-12-11 | 桂林电子科技大学 | 自建地图家用清洁机器人及清洁方法 |
CN105310604A (zh) * | 2014-07-30 | 2016-02-10 | Lg电子株式会社 | 机器人清洁系统以及控制机器人清洁器的方法 |
CN104406539A (zh) * | 2014-11-21 | 2015-03-11 | 浙江工业大学 | 全天候主动式全景感知装置及3d全景建模方法 |
US20160144505A1 (en) * | 2014-11-26 | 2016-05-26 | Irobot Corporation | Systems and Methods for Performing Occlusion Detection |
CN105607635A (zh) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制系统及全向自动导引车 |
CN105785989A (zh) * | 2016-02-24 | 2016-07-20 | 中国科学院自动化研究所 | 利用行进中机器人标定分布式网络摄像机的系统和相关方法 |
Non-Patent Citations (2)
Title |
---|
LIU MING,QIU KEJIE,CHE FENGYU ETC.: "Towards indoor localization using Visible Light Communication for consumer electronic devices", 《2014 IEEE/RSJ INTERNATIONAL CONFERENCE ON INTELLIGENT ROBOTS AND SYSTEMS》 * |
方毅: "基于 RFID 技术的移动机器人定位方法研究", 《研究与设计》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113268063A (zh) * | 2021-06-03 | 2021-08-17 | 北京京东乾石科技有限公司 | 机器人的控制方法、装置和非易失性计算机可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN109373992B (zh) | 2022-02-22 |
US20190164306A1 (en) | 2019-05-30 |
CN108139213B (zh) | 2018-12-21 |
WO2018032488A1 (zh) | 2018-02-22 |
CN108139213A (zh) | 2018-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108139213B (zh) | 基于发光设备的地图构建方法、纠正方法及装置 | |
CN107836013B (zh) | 地图构建方法、纠正方法及装置 | |
CN106537169B (zh) | 基于色块标签的定位与地图构建方法及其装置 | |
US10656659B2 (en) | Method and apparatus for localization and mapping based on RFID | |
US10481237B2 (en) | Method and apparatus for using gestures to control a measurement device | |
CN106227212B (zh) | 基于栅格地图和动态校准的精度可控室内导航系统及方法 | |
US8396597B2 (en) | Distributed robotic guidance | |
JP2012084149A (ja) | モバイル機器のナビゲーション | |
CN109839118A (zh) | 路径规划方法、系统、机器人和计算机可读存储介质 | |
US20110170118A1 (en) | Device and Method for Determining a Position and Orientation | |
Mautz et al. | Optical indoor positioning systems | |
CN111536976A (zh) | 一种校园穿梭防控系统 | |
JPH07139942A (ja) | 測量装置 | |
Yan et al. | CurveLight: An Accurate and Practical Light Positioning System | |
CN113029159A (zh) | 一种室内移动机器人视觉定位导航系统 | |
CN113515114A (zh) | 导航避障小车系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20210816 Address after: 510700 room 621, No. 2, Tengfei First Street, Huangpu District, Guangzhou City, Guangdong Province Applicant after: Guangzhou Xiaoluo robot Co.,Ltd. Address before: 510555 room 621, Tengfei Street 2, Guangzhou knowledge city, Guangzhou, Guangdong. Applicant before: GUANGZHOU AIROB ROBOT TECHNOLOGY Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |