CN107836013A - 地图构建方法、纠正方法及装置 - Google Patents

地图构建方法、纠正方法及装置 Download PDF

Info

Publication number
CN107836013A
CN107836013A CN201680030044.6A CN201680030044A CN107836013A CN 107836013 A CN107836013 A CN 107836013A CN 201680030044 A CN201680030044 A CN 201680030044A CN 107836013 A CN107836013 A CN 107836013A
Authority
CN
China
Prior art keywords
map
mark
angle
ccd
cmos
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
Application number
CN201680030044.6A
Other languages
English (en)
Other versions
CN107836013B (zh
Inventor
李北辰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang Qiyuan Robot Co.,Ltd.
Original Assignee
Guangzhou Airob Robot Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangzhou Airob Robot Technology Co ltd filed Critical Guangzhou Airob Robot Technology Co ltd
Publication of CN107836013A publication Critical patent/CN107836013A/zh
Application granted granted Critical
Publication of CN107836013B publication Critical patent/CN107836013B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/50Depth or shape recovery
    • G06T7/55Depth or shape recovery from multiple images
    • G06T7/579Depth or shape recovery from multiple images from motion
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/46Indirect determination of position data
    • G01S17/48Active triangulation systems, i.e. using the transmission and reflection of electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F16/00Information retrieval; Database structures therefor; File system structures therefor
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F16/00Information retrieval; Database structures therefor; File system structures therefor
    • G06F16/20Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
    • G06F16/29Geographical information databases
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T11/002D [Two Dimensional] image generation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/70Determining position or orientation of objects or cameras
    • G06T7/73Determining position or orientation of objects or cameras using feature-based methods
    • G06T7/74Determining position or orientation of objects or cameras using feature-based methods involving reference images or patches
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/80Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30204Marker

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Databases & Information Systems (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Data Mining & Analysis (AREA)
  • General Engineering & Computer Science (AREA)
  • Optics & Photonics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

一种地图构建方法,适用于对设有至少一个激光设备的待定位区域进行实时地图构建,包括步骤:以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值(S11);以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域(S12),在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值(S13);完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图(S14)。

Description

地图构建方法、纠正方法及装置 技术领域
本发明涉及即时定位与地图构建领域,尤其涉及一种地图构建方法、纠正方法及装置。
背景技术
移动装置的定位和地图构建是机器人领域的热点研究问题。对于已知环境中的移动装置自主定位和已知机器人位置的地图创建已经有了实用的解决方法。然而,在很多环境中移动装置不能利用全局定位***进行定位,而且事先获取移动装置工作环境的地图很困难,甚至是不可能的。这时移动装置需要在自身位置不确定的条件下,在完全未知环境中构建地图,同时利用地图进行自主定位和导航。这就是所谓的即时定位与地图构建(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;将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
纠正过程:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
作为上述方案的改进,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
作为上述方案的改进,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
作为上述方案的改进,所述可移动电子设备为机器人。
作为上述方案的改进,所述方法适用于对室内的待定位区域进行实时地图构建。
作为上述方案的改进,所述激光设备适于被设置在房间门框的左侧和/或右侧墙壁上。
本发明实施例公开了一种地图纠正方法,包括:
标定步骤:将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
纠正步骤:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
作为上述方案的改进,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
作为上述方案的改进,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
作为上述方案的改进,所述可移动电子设备为机器人。
作为上述方案的改进,所述地图可通过上述地图构建方法构建。
本发明实施例公开了一种地图纠正方法,包括:
将可移动设备移动到通过初始标定得到的参考坐标点上,记录激光设备投影出来的标志中心投影到CCD/CMOS上的当前像素点位置A3,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及当前像素点位置A3与初始标定的参考点像素点位置A2的像素差,得到 可移动设备在地图坐标系的偏离距离L=(A3-A2)*L’;
记录可移动设备此时在参考坐标点上的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,基于初始标定记录的在参考坐标点时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2,得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);
根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
作为上述方案的改进,所述初始标定过程如下:
将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;
将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;
记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;所述第二位置R2为参考坐标点;
记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2。
作为上述方案的改进,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
作为上述方案的改进,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
作为上述方案的改进,所述可移动电子设备为机器人。
作为上述方案的改进,所述地图通过上述地图构建方法构建。
本发明实施例对应公开了一种地图构建装置,适用于对设有至少一个激光设备的待定位区域进行实时地图构建,所述地图构建装置为可移动设备,所述可移动设备包括:
摄像头,用于采集激光设备投影出来的标志;
坐标系构建及记录单元,用于在可移动电子设备初次沿一定的运动轨迹移动时,使所述摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
编码器,用于在所述可移动电子设备以所述坐标原点作为起始点移动并遍历整个待定位区域的过程中,基于陀螺仪实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离;
障碍物检测部件,用于检测障碍物;
第一计算单元,用于每当所述障碍物检测部件检测到障碍物时,基于所述编码器得到的相对所述起始点的移动方向和移动距离,计算每一所述障碍物位置的坐标值,并将计算到的坐标值发送给所述坐标系构建及记录单元;
地图构建单元,基于所述坐标系构建及记录单元记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
作为上述方案的改进,所述激光设备的数量为两个及以上,且每一个激光设备对应设置在所述待定位区域的特定位置上,每一所述激光设备投影出来的标志信息包括用于区别其绝对位置的唯一编码信息,所述唯一编码信息可通过特定图形表示;所述装置还包括:
第二计算单元,用于在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他激光设备投影出来的标志中心与CCD/CMOS中心点重合时的其他激光设备位置的坐标值,并将其他标志信息及对应的坐标值发送给所述坐标系构建及记录单元。
作为上述方案的改进,每一个所述激光设备投影出来的标志信息还包括用于区别可进入区域/禁止进入区域的区域编码信息,投影出带有禁止进入区域的区域编码信息的激光设备所在的分界线后的特定区域限定为禁止进入区域,所述区域编码信息通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域,所述装置还包括:
区域识别单元,用于当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进。
作为上述方案的改进,所述地图构建单元在完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图时,还基于每一所述标志信息中的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
作为上述方案的改进,所述障碍物检测部件包括碰撞传感器、激光传感器或红外传感器;:
当利用碰撞传感器感测碰到障碍物时,所述第一计算单元将计算得到的所述可移动电子设备当前位置的坐标值作为所述障碍物位置的坐标值;或
当利用激光传感器/红外传感器来探测到障碍物时,根据激光/红外距离计算原理计算出障碍物相对当前所述可移动电子设备的位置,并发送给所述第一计算单元,所述第一计算单元基于计算得到的所述可移动电子设备当前位置的坐标值以及所述障碍物相对当前所述可移动电子设备的位置,从而计算得到障碍物位置的坐标值。
作为上述方案的改进,所述装置还包括:
标定单元,用于当将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;以及将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
纠正单元,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
作为上述方案的改进,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标 志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
作为上述方案的改进,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
作为上述方案的改进,所述可移动电子设备为机器人。
作为上述方案的改进,所述装置适用于对室内的待定位区域进行实时地图构建。
作为上述方案的改进,所述激光设备适于被设置在房间门框的左侧和/或右侧墙壁上。
本发明对应公开了一种地图纠正装置,包括:
标定单元,用于将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;以及将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
纠正单元,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
作为上述方案的改进,
所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
作为上述方案的改进,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
作为上述方案的改进,所述可移动电子设备为机器人。
作为上述方案的改进,所述地图可通过上述地图构建装置构建。
本发明实施例对应公开了一种地图纠正装置,包括:
偏离距离计算单元,用于将可移动设备移动到通过初始标定得到的参考坐标点上,记录激光设备投影出来的标志中心投影到CCD/CMOS上的当前像素点位置A3,基于初始标定得 到的每一像素点对应的地图坐标系距离L’以及当前像素点位置A3与初始标定的参考点像素点位置A2的像素差,得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*L’;
偏离角度计算单元,用于记录可移动设备此时在参考坐标点上的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,基于初始标定记录的在参考坐标点时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2,得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);
纠正单元,根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
作为上述方案的改进,所述初始标定过程如下:
将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;
将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;
记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;所述第二位置R2为参考坐标点;
记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2。
所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
作为上述方案的改进,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。作为上述方案的改进,所述地图可通过上述地图构建装置构建。
与现有技术相比,本发明公开的一种地图构建方法、纠正方法及装置,通过在待定位区域中设置至少一个激光设备,并基于可移动电子设备初次移动时摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;然后以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。因此,本发明只需要一个或以上的激光设备即可实现待定位区域的定位及地图构建,而且方法简单,精确度高,具有成本低、操作简单且有效的技术效果。另外,在构建地图后,能够利用摄像头对激光设备的识别对构建的地图进行纠正,防止因为可移动设备上的陀螺仪发生漂移或者轮子打滑等因素造成的地图误差。
附图说明
图1是本发明实施例1中一种地图构建方法的流程示意图。
图2是本发明实施例2中一种地图构建方法的流程示意图。
图3是本发明实施例3中一种地图构建方法的流程示意图。
图4是本发明实施例4中一种地图构建方法的流程示意图。
图5是本发明实施例5中一种地图构建装置的结构框图。
图6是本发明实施例6中一种地图构建装置的结构框图。
图7是本发明实施例7中一种地图构建装置的结构框图。
图8是本发明实施例8中一种地图构建装置的结构框图。
图9是本发明实施例9中一种地图纠正方法的流程示意图。
图10是本发明实施例10中一种地图纠正方法的流程示意图。
图11是本发明实施例11中一种地图纠正装置的结构框图。
图12是本发明实施例12中一种地图纠正装置的结构框图。
图13a~13c显示了三种不同的标志,从而作为区别其绝对位置的唯一编码信息。
图14a~14c显示了三种不同的标志,从而作为区别其绝对位置的唯一编码信息以及区别可进入区域/禁止进入区域的区域编码信息。
图15显示了对构建的地图进行纠正的过程。
图16显示了激光投影标志在CCD/CMOS上的成像示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
参见图1,是本发明实施例1提供的一种地图构建方法的流程示意图。该地图构建方法适用于利用可移动电子设备对设有至少一个激光设备的待定位区域进行实时地图构建,该可移动电子设备可为例如:机器人。
本实施例的地图构建方法包括步骤:
S11、以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
S12、以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域;
S13、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
S14、完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
在步骤S11中,在待定位及地图构建的区域的至少一个特定位置/任意位置放置一个激光设备后,需要对该整个区域进行定位和构建地图,则需要通过可移动电子设备遍历整个区域才能获得区域中的相关信息。在第一次遍历开始时,可移动电子设备上的摄像头所采集到的第一个所述激光设备投影出来的标志中心与可移动设备上的CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点时,将激光设备的位置(也即,可移动电子设备将此时的位置)作为由X轴和Y轴构成的坐标系中的坐标原点,并记录所述第一个所述标志信息及对应的坐标值。可以理解的,这里提及的“对应的坐标值”是指第一激光设备的位置的坐标值,也就是可移动电子设备当前的位置的坐标值。
可以理解的,为了方便计算和构图,将获取到的第一个所述激光设备投影出来的标志中 心与可移动设备上的CCD/CMOS中心点重合时,可移动设备的位置作为由X轴和Y轴构成的坐标系的坐标原点。但是,所述位置并不局限于只能作为由X轴和Y轴构成的坐标系的坐标原点,也可以是标记为其他参照点,具备参考作用即可,以方便记录其他点的信息。
其中,在本实施例中,所述至少一个激光设备对应设置在所述待定位区域的特定位置上,所述激光设备投影出来的标志包括用于区别其绝对位置的唯一编码信息,而所述唯一编码信息可通过不同图案表示。参考图13,在图13中,不同的标志中包括用于区别其绝对位置的唯一编码信息(标记点),通过不同图案来区分不同的信息,例如,由两个短直线构成的标记点代表标志1,由三个短直线构成的标记点代表标志2,由四个短直线构成的标记点代表标志3……;。
可以理解的,上述只是给出了较为简单易懂的标志的说明,但并不局限于此。标志的构成是有多种方式的,具体示需要定位的待定位区域的环境需要标志数量来决定采用哪个方式更方便。在本实施例中,可移动电子设备通过摄像头来读取标志信息。
在步骤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等。因此,通过获取每一个激光设备投影出来的标志中的唯一编码信息时,经过识别能够确定该激光设备所处的绝对位置。
关于标志的唯一编码信息的表示方式,可参考图13以及上述实施例1中的相关描述。
可以理解的,本实施例的地图构建方法适用于对室内的待定位区域进行实时地图构建。在对室内环境进行定位时,优选在该室内的每一个房间门框的左侧和/或右侧墙壁上设置一个所述激光设备。所述激光设备投影出相应的标志到门框上或天花板上。
这样,基于记录的每一个标志信息及相应的坐标值以及每一个障碍物位置的坐标值完成地图构建后,所述可移动电子设备可以基于每一个标志中的唯一编码信息来实现绝对位置的导航和分辨。例如,需要机器人遍历一趟房间2的时候,可以基于放置在该房间2的门框的左侧和/或右侧墙壁上的激光设备投影出来的标志中的唯一编码信息来确定房间2的绝对位置,并基于该激光设备位置在构建的地图上的相对坐标值(相对坐标原点的方向和距离),从而导航可移动电子设备从到达该房间2。
另外,基于每一个标志中的唯一编码信息,还能使可移动设备(机器人)知道其“身在何处”。例如,对于清洁机器人,需要对室内的多个房间进行清洁时,这样,通过识别每一个房间对应的标志中的唯一编码信息,就能确定自身处于哪个房间,从而防止多次对同一个房间进行清洁,以减少重复工作。区分房间的主要目的是一间一间的房间清扫,这样效率会比较高。这样,对于机器人遍历来说会少走很多重复路线。
参考图3,是本发明实施例3提供的一种地图构建方法的流程示意图。该方法适用于利用可移动电子设备对设有两个或以上激光设备的待定位区域进行实时地图构建。其中,每一个激光设备对应设置在所述待定位区域的特定位置上,每一所述激光设备投影出来的标志包括用于区别其绝对位置的唯一编码信息以及用于区别可进入区域/禁止进入区域的区域编码信息。其中,带有禁止进入区域的区域编码信息的标志将对应的激光设备所在的分界线后的特定区域限定为禁止进入区域。所述唯一编码信息可通过不同图案表示;而所述区域编码信息可通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域。该可移动电子设备可为,例如:机器人。
本实施例的地图构建方法包括步骤:
S31、以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
S32、基于获取的第一个所述标志中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进;
S33、以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域;
S34、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
S35、在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他激光设备投影出来的标志中心与CCD/CMOS中心点重合时的其他激光设备位置的坐标值,并记录其他标志信息及对应的坐标值;
S36、当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策 略,使所述可移动电子设备避开所述禁止进入区域而继续前进;
S37、完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图,并基于每一所述标志中的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
在每一个所述标志中,均包括所述唯一编码信息和所述区域编码信息,所述唯一编码信息可通过不同图案表示;而所述区域编码信息可通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域。参考图14,每一个标志均包括唯一编码信息和区域编码信息,通过不同图案来表示唯一编码信息以区分不同的激光设备,例如,由两个短直线构成的标记点代表标志1,由三个短直线构成的标记点代表标志2,由四个短直线构成的标记点代表标志3……;同时用两种不同的形状来表示可进入区域和禁止进入区域,例如,短直线之间完全平行的表示可进入区域,短直线之间非完全平行的(例如交叉)表示禁止进入区域。。
可以理解的,上述只是给出了较为简单易懂的标志的说明,但并不局限于此。
可见,本实施例在实施例2的基础上,还增加了一个效果,即解决了自动识别禁止进入区域问题(也称为虚拟墙)。在机器人识别禁止进入区域的解决问题上,传统方法主要是利用以下方式:
一种是irobot公司提出的采用红外线发射装置置于期望禁止进入区域分界线上,机器人检测到红外线以后就不会越过该界线。这种方法的不足是红外线发射装置需要安装电池,给用户带来不便,另外一方面,该装置放置在分界线附近,如果家里有宠物等碰到改装置,该装置会移动,失去作用。
另外一种方法是Neato公司提出的采用磁条做分界线的方法,该方法需要用户将磁条贴于禁止进入区域的分界线上,采用霍尔传感器感应来区分。该方法的不足之处在于磁条贴于地面影响地面美观,另外一方面,用户如果希望更换禁止进入区域,磁条贴于地面不方便拆装。
而本实施例通过将用于区别可进入区域/禁止进入区域的区域编码信息置于每一个激光设备投影出来的标志中,其中,带有禁止进入区域的区域编码信息的标志将对应的激光设备所在的分界线后的特定区域限定为禁止进入区域。这样,当可移动设备识别到标志中的区域编码信息后即可区分。在识别为禁止进入区域后,结合预设的避开策略,即可使所述可移动电子设备避开所述禁止进入区域而继续前进。另外,在遍历完成后,基于每一所述标志的区域编码信息,还可以在构建的地图上具体标示为可进入区域/禁止进入区域,以利于导航。
可以理解的,可以在可移动设备中预先设置标志不同的区域编码信息代表可进入区域/禁止进入区域的关系对照表,这样,当获取的每一个所述标志信息中的区域编码信息时,通过该对照表即可识别为可进入区域还是禁止进入区域。
其中,本实施例的预设的避开策略优选为:在识别出该区域为禁止进入区域时,使所述可移动电子设备后退P厘米并且向左/右旋转Q°后继续前进,其中,P不少于所述分界线的长度,45≤Q≤90。基于该预设的避开策略,基本上可以保证所述可移动电子设备能够避开所述禁止进入区域而继续前进。
另外,可通过以下方式来区分禁止进入区域和可进入区域之间的分界线:当可移动设备判断标志中的区域编码信息为禁止进入区域时,移动可移动设备在标签的左右两边寻找障碍物(墙壁)和无障碍区域,墙壁的延伸线就是禁止进入区域与可进入区域的分界线。
可以理解的,除了这里公开的避开策略外,本实施例的避开策略还可以采用其他方式,并不局限于此。
在利用本实施例的方法进行室内定位及地图构建时,优选在该室内的每一个房间门框的左侧和/或右侧墙壁上设置一个激光设备,由激光设备投影出相应的标志到门框上或天花板上。
可见,相比现有技术中的虚拟墙技术,本发明实施例通过将用于区别可进入区域/禁止进入区域的区域编码信息置于(例如,房间门框边的固定槽内的)每一个标志中,使得可移动设备获取并识别标志中的区域编码信息后,即可确定该区域能够进入。因此,本实施例的成本低,而且不影响整体美观,还容易更换。
参考图4,是本发明实施例4提供的一种地图构建方法的流程示意图。通过机器人的驱动轮轴上安装的编码器来实时记录机器人相对所述起始点的移动方向和移动距离时,由于打滑、两驱动轮和地面接触点之间距离的不确定等原因,使得编码器的测算过程存在累积误差,另外,由于陀螺仪漂移也会对构建的地图造成偏差。因此,本实施例在前述实施例的基础上,对构建的地图进行纠正,防止因为可移动设备上的陀螺仪发生漂移或者轮子打滑等因素造成的地图误差,使得基于坐标值构建的地图更为精确。
具体的,本实施例在前述实施例1~实施例3的基础上构建得到地图后,增加对地图的纠正处理,具体包括:
S41、标定过程:将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
S42、纠正过程:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
在本实施例中,可移动设备中设置两个坐标系,一个是待定位区域的地图构建坐标系,一个是可移动设备中的摄像头的CCD/CMOS坐标系。其中,CCD/CMOS坐标系是指激光设备投影标志到CCD/CMOS上所在像素点位置而形成的,CCD/CMOS坐标系也包括X轴和Y轴。
具体的,激光设备投影出来的标志包括位置纠正标志点和角度纠正标志,其中,位置纠正标记点用于纠正位置,角度纠正标志用于纠正角度。在本实施例中,如图16所示,位置纠正标志点由短直线161构成,而角度纠正标志为长直线162,能在CCD/CMOS整个范围都形成投影。另外,所述位置纠正标志点位于整个标志的中心。
利用本实施例对构建的地图进行纠正前,首先需要进行标定。例如,对于室内定位和地图构建来说,每家每户房子的层高不一样,这样激光设备投影标志在摄像头CCD/CMOS上X轴或者Y轴每偏离一个像素点,可移动设备对应在地图坐标系(即地面坐标系)上运动距离也会不一样,所以需要标定。
具体标定过程为,当可移动设备(例如,机器人)在运动过程中到达第一位置R1时摄像头检测到激光设备投影出来的标志中心投影到CCD/CMOS上,如图1所示的第一像素位置A1点。标记出激光投影标记点投影到CCD/CMOS上的位置,让机器人运动朝着让激光设备投影往摄像头CCD/CMOS中央的方向运动。当机器人运动了某一特定距离(例如500毫米)到达第二位置R2,这时,记录出激光设备投影出来的标志中心投影到CCD/CMOS的另外一个像素位置A2点。从而可以计算出A1点和A2点之间的像素差值。通过运动的距离 除以像素点数就可以求出一个像素点对应了机器人在地面坐标系距离。同时,记录机器人当前(即第二位置R2)所在地面坐标系的坐标值以及该坐标值对应的激光投影出来的标志中心投影到CCD/CMOS像素坐标值。这个坐标值(即第二位置R2)作为纠正时的参考坐标点。
以上为参考坐标点是为了能标定机器人位置。为了纠正角度,机器人还需要记录角度值:包括机器人在第二位置R2时的角度α1(角度α1可以通过陀螺仪计算得到)以及通过CCD/CMOS像素记录出来的角度α2。如图15所示为激光设备投影在天花板上的标志(图案),当然,图案也不仅仅限于此。图16为激光投影图案在CCD/CMOS上的成像。在标定过程中,可以通过以下公式获得投影在CCD/CMOS上的角度α2:
α2=arctan(y1/x1);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
在标定完成后,当机器人运行一段时间(例如20分钟)需要纠正已构建的地图时,机器人运动到参考坐标点所在的位置(即第二位置R2)。通过这一次在CCD/CMOS的像素位置与上一次位置差可以知道偏离了多少个像素。通过多少个像素乘以标定时的距离便可以求出机器人在地面坐标系偏离了多少距离。
具体的,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L。
当机器人运动到第二位置R2以后,机器人此时所处的角度α3是可以根据陀螺仪计算出来的。而CCD/CMOS上的激光设备投影出来的标记角度α4通过以下公式计算得到:
α4=arctan(y2/x2);
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
那么,机器人角度的偏差值为α=(α1-α3)-(α2-α4)。这时,根据计算出来的所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正,从而得到纠正后的地图。
参见图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;以及将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
纠正单元82,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
本实施例的地图构建装置的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
本发明实施例还公开了一种智能移动设备,包括移动装置以及如图5~图8所示的任意实施例的地图构建装置。该智能移动设备优选为机器人。
参考图9,图9是本发明实施例9中一种地图纠正方法的流程示意图。该地图纠正方法包括步骤:
S91、标定步骤:将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
S92、纠正步骤:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
其中,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例1~实施例4中任一项所述的地图构建方法构建得到。
本实施例的地图纠正方法的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
参考图10,图10是本发明实施例10中一种地图纠正方法的流程示意图。该地图纠正方法包括步骤:
S101、将可移动设备移动到通过初始标定得到的参考坐标点上,记录激光设备投影出来的标志中心投影到CCD/CMOS上的当前像素点位置A3,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及当前像素点位置A3与初始标定的参考点像素点位置A2的像素差,得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*L’;
S102、记录可移动设备此时在参考坐标点上的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,基于初始标定记录的在参考坐标点时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2,得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4):
S103、根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
其中,所述初始标定过程如下:
(1)将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;
(2)将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;
(3)记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;所述第二位置R2为参考坐标点;
(4)记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2。
其中,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例1~实施例4中任一项所述的地图构建方法构建得到。
本实施例的地图纠正方法的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
参考图11,图11是本发明实施例11中一种地图纠正装置的结构框图。该地图纠正装置包括:
标定单元111,用于将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;以及将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录 可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
纠正单元112,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
其中,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例5~实施例8中任一项所述的地图构建装置构建得到。
参考图12,图12是本发明实施例12中一种地图纠正装置的结构框图。该地图纠正装置包括:
偏离距离计算单元121,用于将可移动设备移动到通过初始标定得到的参考坐标点上,记录激光设备投影出来的标志中心投影到CCD/CMOS上的当前像素点位置A3,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及当前像素点位置A3与初始标定的参考点像素点位置A2的像素差,得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*L’;
偏离角度计算单元122,用于记录可移动设备此时在参考坐标点上的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,基于初始标定记录的在参考坐标点时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2,得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);
纠正单元123,根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
其中,所述初始标定过程如下:
(1)将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;
(2)将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;
(3)记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;所述第二位置R2为参考坐标点;
(4)记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2。
其中,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
α2=arctan(y1/x1);
α4=arctan(y2/x2);
其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
优选的,在本实施例中,所述可移动电子设备为机器人。
可以理解的,本实施的所述地图可通过实施例5~实施例8中任一项所述的地图构建装置构建得到。
本实施例的地图纠正方法的工作原理和过程可参考上述实施例4的相关描述,在此不再赘述。
需要说明的是,在本说明书中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
最后,还需要说明的是,上述一系列处理不仅包括以这里所述的顺序按时间序列执行的处理,而且包括并行或分别地、而不是按时间顺序执行的处理。通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到本发明可借助软件加必需的硬件平台的方式来实现,当然也可以全部通过软件来实施。基于这样的理解,本发明的技术方案对背景技术做出贡献的全部或者部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例或者实施例的某些部分所述的方法。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。

Claims (40)

  1. 一种地图构建方法,其特征在于,适用于对设有至少一个激光设备的待定位区域进行实时地图构建,包括步骤:
    以可移动电子设备初次沿一定的运动轨迹移动时,可移动电子设备上的摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
    以所述坐标原点作为起始点移动所述可移动电子设备并遍历整个待定位区域,在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算并记录所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值;
    完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
  2. 如权利要求1所述的地图构建方法,其特征在于,所述激光设备的数量为两个及以上,且每一个激光设备对应设置在所述待定位区域的特定位置上,每一所述激光设备投影出来的标志信息包括用于区别其绝对位置的唯一编码信息,所述唯一编码信息可通过特定图形表示;所述方法还包括步骤:
    在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他激光设备投影出来的标志中心与CCD/CMOS中心点重合时的其他激光设备位置的坐标值,并记录其他标志信息及对应的坐标值。
  3. 如权利要求2所述的地图构建方法,其特征在于,每一个所述激光设备投影出来的标志信息还包括用于区别可进入区域/禁止进入区域的区域编码信息,投影出带有禁止进入区域的区域编码信息的激光设备所在的分界线后的特定区域限定为禁止进入区域,所述区域编码信息通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域,所述方法还包括步骤:
    当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进。
  4. 如权利要求3所述的地图构建方法,其特征在于,在完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图时,还基于每一所述标志信息中的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
  5. 如权利要求1所述的地图构建方法,其特征在于,通过以下方式来计算所述可移动电子设备每一次检测到障碍物时的障碍物位置的坐标值:
    利用碰撞传感器来感应障碍物,当碰撞传感器感测碰到障碍物时,将所述可移动电子设备的坐标值作为所述障碍物位置的坐标值;或
    利用激光传感器/红外传感器来探测障碍物,当激光传感器/红外传感器来探测到障碍物时,根据激光/红外距离计算原理计算出障碍物相对当前所述可移动电子设备的位置,从而计算出所述障碍物位置的坐标值。
  6. 如权利要求2所述的地图构建方法,其特征在于,还包括:
    标定过程:将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标 志中心投影到CCD/CMOS上的第一像素点位置A1;将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
    纠正过程:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
  7. 如权利要求6所述的地图构建方法,其特征在于,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
    α2=arctan(y1/x1);
    α4=arctan(y2/x2);
    其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
    其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
  8. 如权利要求7所述的地图构建方法,其特征在于,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
  9. 如权利要求1所述的地图构建方法,其特征在于,所述可移动电子设备为机器人。
  10. 如权利要求1所述的地图构建方法,其特征在于,所述方法适用于对室内的待定位区域进行实时地图构建;或/和所述激光设备适于被设置在房间门框的左侧和/或右侧墙壁上。
  11. 一种地图纠正方法,其特征在于,包括:
    标定步骤:将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
    纠正步骤:在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
  12. 如权利要求11所述的地图纠正方法,其特征在于,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下 计算公式得到:
    α2=arctan(y1/x1);
    α4=arctan(y2/x2);
    其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
    其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
  13. 如权利要求11所述的地图构建方法,其特征在于,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
  14. 如权利要求11所述的地图纠正方法,其特征在于,所述可移动电子设备为机器人。
  15. 如权利要求11所述的地图纠正方法,其特征在于,所述地图可通过权利要求1~10任一项所述的地图构建方法构建。
  16. 一种地图纠正方法,其特征在于,包括:
    将可移动设备移动到通过初始标定得到的参考坐标点上,记录激光设备投影出来的标志中心投影到CCD/CMOS上的当前像素点位置A3,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及当前像素点位置A3与初始标定的参考点像素点位置A2的像素差,得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*L’;
    记录可移动设备此时在参考坐标点上的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,基于初始标定记录的在参考坐标点时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2,得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);
    根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
  17. 如权利要求15所述的地图纠正方法,其特征在于,所述初始标定过程如下:
    将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;
    将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;
    记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;所述第二位置R2为参考坐标点;
    记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2。
  18. 如权利要求16或17所述的地图纠正方法,其特征在于,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
    α2=arctan(y1/x1);
    α4=arctan(y2/x2);
    其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
    其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在 CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
  19. 如权利要求18所述的地图纠正方法,其特征在于,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
  20. 如权利要求16或17所述的地图纠正方法,其特征在于,所述地图通过权利要求21~30任一项所述的地图构建方法构建。
  21. 一种地图构建装置,其特征在于,适用于对设有至少一个激光设备的待定位区域进行实时地图构建,所述地图构建装置为可移动设备,所述可移动设备包括:
    摄像头,用于采集激光设备投影出来的标志;
    坐标系构建及记录单元,用于在可移动电子设备初次沿一定的运动轨迹移动时,使所述摄像头所采集到的第一个所述激光设备投影出来的标志中心与CCD/CMOS中心点重合的位置作为地图坐标系的坐标原点,并记录所述第一个标志信息及相应的坐标值;
    编码器,用于在所述可移动电子设备以所述坐标原点作为起始点移动并遍历整个待定位区域的过程中,基于陀螺仪实时计算所述可移动电子设备相对所述起始点的移动方向和移动距离;
    障碍物检测部件,用于检测障碍物;
    第一计算单元,用于每当所述障碍物检测部件检测到障碍物时,基于所述编码器得到的相对所述起始点的移动方向和移动距离,计算每一所述障碍物位置的坐标值,并将计算到的坐标值发送给所述坐标系构建及记录单元;
    地图构建单元,基于所述坐标系构建及记录单元记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图。
  22. 如权利要求21所述的地图构建装置,其特征在于,所述激光设备的数量为两个及以上,且每一个激光设备对应设置在所述待定位区域的特定位置上,每一所述激光设备投影出来的标志信息包括用于区别其绝对位置的唯一编码信息,所述唯一编码信息可通过特定图形表示;所述装置还包括:
    第二计算单元,用于在遍历过程中,基于所述可移动电子设备相对所述起始点的移动方向和移动距离,计算所述可移动电子设备的摄像头每一次所采集到的其他激光设备投影出来的标志中心与CCD/CMOS中心点重合时的其他激光设备位置的坐标值,并将其他标志信息及对应的坐标值发送给所述坐标系构建及记录单元。
  23. 如权利要求21所述的地图构建装置,其特征在于,每一个所述激光设备投影出来的标志信息还包括用于区别可进入区域/禁止进入区域的区域编码信息,投影出带有禁止进入区域的区域编码信息的激光设备所在的分界线后的特定区域限定为禁止进入区域,所述区域编码信息通过同一种形状代表可进入区域,并通过另一种形状代表禁止进入区域,所述装置还包括:
    区域识别单元,用于当所述可移动电子设备获取到每一个标志信息时,首先基于所述标志信息中的区域编码信息识别为可进入区域还是禁止进入区域,若为禁止进入区域,则根据预设的避开策略,使所述可移动电子设备避开所述禁止进入区域而继续前进。
  24. 如权利要求23所述的地图构建装置,其特征在于,所述地图构建单元在完成遍历后,基于记录的标志信息及相应的坐标值以及每一个障碍物位置的坐标值构建地图时,还基于每一所述标志信息中的区域编码信息在构建的地图上标示为可进入区域/禁止进入区域。
  25. 如权利要求21所述的地图构建装置,其特征在于,所述障碍物检测部件包括碰撞传感器、激光传感器或红外传感器;:
    当利用碰撞传感器感测碰到障碍物时,所述第一计算单元将计算得到的所述可移动电子设备当前位置的坐标值作为所述障碍物位置的坐标值;或
    当利用激光传感器/红外传感器来探测到障碍物时,根据激光/红外距离计算原理计算出障碍物相对当前所述可移动电子设备的位置,并发送给所述第一计算单元,所述第一计算单元基于计算得到的所述可移动电子设备当前位置的坐标值以及所述障碍物相对当前所述可移动电子设备的位置,从而计算得到障碍物位置的坐标值。
  26. 如权利要求22所述的地图构建装置,其特征在于,所述装置还包括:
    标定单元,用于当将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;以及将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
    纠正单元,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
  27. 如权利要求26所述的地图构建装置,其特征在于,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
    α2=arctan(y1/x1);
    α4=arctan(y2/x2);
    其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
    其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上的像素差值。
  28. 如权利要求27所述的地图构建装置,其特征在于,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
  29. 如权利要求21所述的地图构建装置,其特征在于,所述可移动电子设备为机器人。
  30. 如权利要求18所述的地图构建装置,其特征在于,所述装置适用于对室内的待定位区域进行实时地图构建;或/和所述激光设备适于被设置在房间门框的左侧和/或右侧墙壁上。
  31. 一种地图纠正装置,其特征在于,包括:
    标定单元,用于将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;以及将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐 标值;并记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2;
    纠正单元,用于在构建地图后的任何时刻需要对地图进行纠正时,将可移动设备移动到所述第二位置R2时,记录激光设备投影出来的标志中心投影到CCD/CMOS上的第三像素点位置A3,从而得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*(A2-A1)/L;并记录可移动设备此时在第二位置R2时的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,从而得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);并根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
  32. 如权利要求31所述的地图纠正装置,其特征在于,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
    α2=arctan(y1/x1);
    α4=arctan(y2/x2);
    其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
    其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
  33. 如权利要求32所述的地图构建装置,其特征在于,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
  34. 如权利要求31所述的地图纠正装置,其特征在于,所述可移动电子设备为机器人。
  35. 如权利要求31所述的地图纠正装置,其特征在于,所述地图可通过权利要求21~30任一项所述的地图构建装置构建。
  36. 一种地图纠正装置,其特征在于,包括:
    偏离距离计算单元,用于将可移动设备移动到通过初始标定得到的参考坐标点上,记录激光设备投影出来的标志中心投影到CCD/CMOS上的当前像素点位置A3,基于初始标定得到的每一像素点对应的地图坐标系距离L’以及当前像素点位置A3与初始标定的参考点像素点位置A2的像素差,得到可移动设备在地图坐标系的偏离距离L=(A3-A2)*L’;
    偏离角度计算单元,用于记录可移动设备此时在参考坐标点上的角度α3以及对应的标志投影到CCD/CMOS上的角度α4,基于初始标定记录的在参考坐标点时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2,得到可移动设备在地图坐标系的偏离角度α=(α1-α3)-(α2-α4);
    纠正单元,根据所述偏离距离L以及偏离角度α对构建的地图上的坐标值进行纠正。
  37. 如权利要求36所述的地图纠正装置,其特征在于,所述初始标定过程如下:
    将可移动设备移动到地图的第一位置R1时记录任一激光设备投影出来的标志中心投影到CCD/CMOS上的第一像素点位置A1;
    将可移动设备朝标志中心往CCD/CMOS中心点靠拢的方向移动特定距离L到达地图的第二位置R2时,记录所述激光设备投影出来的标志中心投影到CCD/CMOS上的第二像素点位置A2,从而得到每一像素点对应的地图坐标系距离为L’=(A2-A1)/L,其中,(A2-A1)表示A2和A1之间的像素点数量;
    记录可移动设备在第二位置R2时地图坐标值以及对应的标志中心投影到CCD/CMOS上的像素坐标值;所述第二位置R2为参考坐标点;
    记录可移动设备在第二位置R2时的角度α1以及对应的标志投影到CCD/CMOS上的角度α2。
  38. 如权利要求36或37所述的地图纠正装置,其特征在于,所述标志包括位置纠正标志点和角度纠正标志,所述位置纠正标志点位于整个标志的中心,所述角度α2和角度α4通过以下计算公式得到:
    α2=arctan(y1/x1);
    α4=arctan(y2/x2);
    其中x1、y1分别为标定过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值;
    其中x2、y2分别为纠正过程中可移动设备到达第二位置R2时采集到的角度纠正标志在CCD/CMOS的X轴上的像素差值、Y轴上像素点的差值。
  39. 如权利要求38所述的地图纠正装置,其特征在于,所述位置纠正标志点为短直线,所述角度纠正标志为长直线。
  40. 如权利要求36或37所述的地图纠正装置,其特征在于,所述地图可通过权利要求21~30任一项所述的地图构建装置构建。
CN201680030044.6A 2016-03-09 2016-03-09 地图构建方法、纠正方法及装置 Active CN107836013B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2016/075955 WO2017152390A1 (zh) 2016-03-09 2016-03-09 地图构建方法、纠正方法及装置

Publications (2)

Publication Number Publication Date
CN107836013A true CN107836013A (zh) 2018-03-23
CN107836013B CN107836013B (zh) 2019-09-03

Family

ID=59788914

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201680030044.6A Active CN107836013B (zh) 2016-03-09 2016-03-09 地图构建方法、纠正方法及装置

Country Status (4)

Country Link
US (1) US10726568B2 (zh)
EP (1) EP3428885A4 (zh)
CN (1) CN107836013B (zh)
WO (1) WO2017152390A1 (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108919300A (zh) * 2018-07-17 2018-11-30 重庆大学 一种面向仓库通道场景的混合地图创建方法
CN109785355A (zh) * 2019-01-25 2019-05-21 网易(杭州)网络有限公司 区域合并方法及装置、计算机存储介质、电子设备
CN109917791A (zh) * 2019-03-26 2019-06-21 深圳市锐曼智能装备有限公司 移动装置自动探索构建地图的方法
CN109978173A (zh) * 2018-12-11 2019-07-05 智能嘉家有限公司 一种用于室内测绘和定位的机器学习diy方法
CN111240322A (zh) * 2020-01-09 2020-06-05 珠海市一微半导体有限公司 机器人移动限制框的工作起点确定方法及运动控制方法
CN112419746A (zh) * 2019-08-20 2021-02-26 广州中广国科测控技术有限公司 一种高速公路通行的车辆车速自监测方法
CN113218392A (zh) * 2020-01-21 2021-08-06 富华科精密工业(深圳)有限公司 室内定位导航方法及导航装置
CN114683270A (zh) * 2020-12-30 2022-07-01 深圳乐动机器人有限公司 一种基于机器人的构图信息采集方法及机器人***
CN114998535A (zh) * 2022-05-26 2022-09-02 湖南格兰博智能科技有限责任公司 一种地图构建的角度偏转矫正方法、***及电子设备

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018032488A1 (zh) * 2016-08-19 2018-02-22 广州艾若博机器人科技有限公司 基于发光设备的地图构建方法、纠正方法及装置
JP6831302B2 (ja) * 2017-06-21 2021-02-17 トヨタ自動車株式会社 レーザ加工品の製造方法および電池の製造方法
WO2020030066A1 (zh) * 2018-08-08 2020-02-13 苏州宝时得电动工具有限公司 自移动设备、自动工作***及其控制方法
WO2020102946A1 (zh) * 2018-11-19 2020-05-28 珊口(深圳)智能科技有限公司 构建地图、定位、导航、控制方法及***、移动机器人
KR20200094843A (ko) * 2019-01-23 2020-08-10 삼성전자주식회사 외부 전자 장치를 제어하는 방법 및 이를 지원하는 전자 장치
CN109946715B (zh) * 2019-04-09 2021-06-25 云鲸智能科技(东莞)有限公司 探测方法、装置、移动机器人及存储介质
GB2584839B (en) * 2019-06-12 2022-12-21 Dyson Technology Ltd Mapping of an environment
CN112147995B (zh) * 2019-06-28 2024-02-27 深圳市创客工场科技有限公司 机器人的运动控制方法及装置、机器人、存储介质
CN111427360B (zh) * 2020-04-20 2023-05-05 珠海一微半导体股份有限公司 基于地标定位的地图构建方法、机器人及机器人导航***
CN111667545B (zh) * 2020-05-07 2024-02-27 东软睿驰汽车技术(沈阳)有限公司 高精度地图生成方法、装置、电子设备及存储介质
CN111625612B (zh) * 2020-05-26 2023-07-18 北京百度网讯科技有限公司 高精地图的纠偏方法和装置、电子设备和存储介质
CN112859862A (zh) * 2021-01-15 2021-05-28 珠海市一微半导体有限公司 一种利用充电桩进行地图修正的方法及***
CN114019953B (zh) * 2021-10-08 2024-03-19 中移(杭州)信息技术有限公司 地图构建方法、装置、设备及存储介质
CN114557640B (zh) * 2022-02-21 2023-08-01 广州宝乐软件科技有限公司 清洁机器人的数据处理方法、装置及清洁机器人
CN116840820B (zh) * 2023-08-29 2023-11-24 上海仙工智能科技有限公司 一种检测2d激光定位丢失的方法及***、存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20110006401A (ko) * 2009-07-14 2011-01-20 주식회사 동원종합기술 시각 장애인을 위한 내비게이션 시스템
CN103439973A (zh) * 2013-08-12 2013-12-11 桂林电子科技大学 自建地图家用清洁机器人及清洁方法
CN104197930A (zh) * 2014-09-11 2014-12-10 金海新源电气江苏有限公司 一种基于惯性制导和射频识别的室内定位装置及方法
CN104330090A (zh) * 2014-10-23 2015-02-04 北京化工大学 机器人分布式表征智能语义地图创建方法

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0142594B1 (en) * 1983-10-26 1989-06-28 Automax Kabushiki Kaisha Control system for mobile robot
JP3879848B2 (ja) * 2003-03-14 2007-02-14 松下電工株式会社 自律移動装置
US7720554B2 (en) * 2004-03-29 2010-05-18 Evolution Robotics, Inc. Methods and apparatus for position estimation using reflected light sources
US8930023B2 (en) * 2009-11-06 2015-01-06 Irobot Corporation Localization by learning of wave-signal distributions
CN100449444C (zh) * 2006-09-29 2009-01-07 浙江大学 移动机器人在未知环境中同时定位与地图构建的方法
CN101033971B (zh) * 2007-02-09 2011-02-16 中国科学院合肥物质科学研究院 一种移动机器人地图创建***及地图创建方法
JP4788722B2 (ja) * 2008-02-26 2011-10-05 トヨタ自動車株式会社 自律移動ロボット、自己位置推定方法、環境地図の生成方法、環境地図の生成装置、及び環境地図のデータ構造
DE102008054453A1 (de) * 2008-12-10 2010-06-17 Robert Bosch Gmbh Messsystem zur Vermessung von Räumen und/oder von Objekten
BR112012010612A2 (pt) * 2009-11-06 2017-08-15 Evolution Robotics Inc Dispositivo móvel configurado para navegar em superfície e método para navegar em superfície com dispositivo móvel
CN102436669A (zh) * 2011-10-13 2012-05-02 中国民用航空总局第二研究所 二维矢量地图绘制方法
CN102395104A (zh) * 2011-10-25 2012-03-28 桂林理工大学 一种用于移动终端自动动态调整地图比例尺的方法
DE102012112036B4 (de) * 2012-12-10 2023-06-07 Miele & Cie. Kg Selbstfahrendes Bodenbearbeitungsgerät und Verfahren zur Navigation bei einem selbstfahrenden Bodenbearbeitungsgerät
CN105527961A (zh) * 2014-09-30 2016-04-27 科沃斯机器人有限公司 一种自移动表面行走机器人***及回归主充电座的方法
DE102014226084A1 (de) * 2014-12-16 2016-06-16 Robert Bosch Gmbh Verfahren zur Kartierung einer Bearbeitungsfläche für autonome Roboterfahrzeuge
KR102328252B1 (ko) * 2015-02-13 2021-11-19 삼성전자주식회사 청소 로봇 및 그 제어방법
EP3278937B1 (en) * 2015-03-31 2020-02-19 Guangzhou Airob Robot Technology Co., Ltd. Charger, and map-constructing-based charger finding method, device and system
EP3303978A4 (en) * 2015-06-07 2018-06-06 Geoffrey Louis Barrows Localization method and apparatus
JP6849330B2 (ja) * 2015-08-28 2021-03-24 パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカPanasonic Intellectual Property Corporation of America 地図生成方法、自己位置推定方法、ロボットシステム、およびロボット
US9946264B2 (en) * 2016-03-22 2018-04-17 Sharp Laboratories Of America, Inc. Autonomous navigation using visual odometry
JP6786912B2 (ja) * 2016-07-05 2020-11-18 富士ゼロックス株式会社 移動ロボットおよび移動制御システム
US9939814B1 (en) * 2017-05-01 2018-04-10 Savioke, Inc. Computer system and method for automated mapping by robots
US10583561B2 (en) * 2017-08-31 2020-03-10 Neato Robotics, Inc. Robotic virtual boundaries
US10586344B2 (en) * 2018-02-21 2020-03-10 Beijing Jingdong Shangke Information Technology Co., Ltd. System and method for feature screening in SLAM

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20110006401A (ko) * 2009-07-14 2011-01-20 주식회사 동원종합기술 시각 장애인을 위한 내비게이션 시스템
CN103439973A (zh) * 2013-08-12 2013-12-11 桂林电子科技大学 自建地图家用清洁机器人及清洁方法
CN104197930A (zh) * 2014-09-11 2014-12-10 金海新源电气江苏有限公司 一种基于惯性制导和射频识别的室内定位装置及方法
CN104330090A (zh) * 2014-10-23 2015-02-04 北京化工大学 机器人分布式表征智能语义地图创建方法

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108919300A (zh) * 2018-07-17 2018-11-30 重庆大学 一种面向仓库通道场景的混合地图创建方法
CN108919300B (zh) * 2018-07-17 2022-07-08 重庆大学 一种面向仓库通道场景的混合地图创建方法
CN109978173A (zh) * 2018-12-11 2019-07-05 智能嘉家有限公司 一种用于室内测绘和定位的机器学习diy方法
CN109785355A (zh) * 2019-01-25 2019-05-21 网易(杭州)网络有限公司 区域合并方法及装置、计算机存储介质、电子设备
CN109917791A (zh) * 2019-03-26 2019-06-21 深圳市锐曼智能装备有限公司 移动装置自动探索构建地图的方法
CN109917791B (zh) * 2019-03-26 2022-12-06 深圳市锐曼智能装备有限公司 移动装置自动探索构建地图的方法
CN112419746A (zh) * 2019-08-20 2021-02-26 广州中广国科测控技术有限公司 一种高速公路通行的车辆车速自监测方法
CN111240322A (zh) * 2020-01-09 2020-06-05 珠海市一微半导体有限公司 机器人移动限制框的工作起点确定方法及运动控制方法
CN113218392A (zh) * 2020-01-21 2021-08-06 富华科精密工业(深圳)有限公司 室内定位导航方法及导航装置
CN114683270A (zh) * 2020-12-30 2022-07-01 深圳乐动机器人有限公司 一种基于机器人的构图信息采集方法及机器人***
CN114998535A (zh) * 2022-05-26 2022-09-02 湖南格兰博智能科技有限责任公司 一种地图构建的角度偏转矫正方法、***及电子设备
CN114998535B (zh) * 2022-05-26 2024-07-12 湖南格兰博智能科技有限责任公司 一种地图构建的角度偏转矫正方法、***及电子设备

Also Published As

Publication number Publication date
US10726568B2 (en) 2020-07-28
CN107836013B (zh) 2019-09-03
US20190005669A1 (en) 2019-01-03
EP3428885A1 (en) 2019-01-16
WO2017152390A1 (zh) 2017-09-14
EP3428885A4 (en) 2019-08-14

Similar Documents

Publication Publication Date Title
CN107836013A (zh) 地图构建方法、纠正方法及装置
US10656654B2 (en) Method and apparatus for localization and mapping based on color block tags
US10656659B2 (en) Method and apparatus for localization and mapping based on RFID
CN108139213A (zh) 基于发光设备的地图构建方法、纠正方法及装置
US5999866A (en) Infrastructure independent position determining system
CN108287544B (zh) 一种智能机器人路线规划及沿原路径返回的方法及***
US10571277B2 (en) Charger, and method, apparatus and system for finding charger based on map constructing
US8807428B2 (en) Navigation of mobile devices
CN107357297A (zh) 一种扫地机器人导航***及其导航方法
JP4530996B2 (ja) 移動ロボット
JP2006252346A (ja) 移動ロボット
CN107357290A (zh) 一种基于磁导航机器人行走***
CN113158779A (zh) 一种行走方法、装置和计算机存储介质
JP4368318B2 (ja) 移動ロボット
Jensfelt et al. A mobile robot system for automatic floor marking
JP4879595B2 (ja) 移動ロボット
Andersen et al. Visual navigation for mobile robots
CN115167402A (zh) 一种除草机器人寻路的方法及***
CN114445698A (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
CB02 Change of applicant information

Address after: 510555 room 621, Tengfei Street 2, Guangzhou knowledge city, Guangzhou, Guangdong.

Applicant after: GUANGZHOU AIROB ROBOT TECHNOLOGY Co.,Ltd.

Address before: 510540 Baiyun Electrical Technology Building, Taihe Town, Baiyun District, Guangzhou, Guangdong, China 702

Applicant before: GUANGZHOU AIROB ROBOT TECHNOLOGY Co.,Ltd.

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20210127

Address after: 510555 room 621, No.2, Tengfei 1st Street, Huangpu District, Guangzhou City, Guangdong Province

Patentee after: Guangzhou Xiaoluo robot Co.,Ltd.

Address before: 510555 room 621, Tengfei Street 2, Guangzhou knowledge city, Guangzhou, Guangdong.

Patentee before: GUANGZHOU AIROB ROBOT TECHNOLOGY Co.,Ltd.

TR01 Transfer of patent right
CP03 Change of name, title or address

Address after: 315100 East 1st Road, Science Park, Jiangshan Town, Yinzhou District, Ningbo City, Zhejiang Province

Patentee after: Zhejiang Qiyuan Robot Co.,Ltd.

Address before: 510555 room 621, No.2, Tengfei 1st Street, Huangpu District, Guangzhou City, Guangdong Province

Patentee before: Guangzhou Xiaoluo robot Co.,Ltd.

CP03 Change of name, title or address