CN107044857B - 应用于服务机器人的异步式地图构建与定位系统及方法 - Google Patents

应用于服务机器人的异步式地图构建与定位系统及方法 Download PDF

Info

Publication number
CN107044857B
CN107044857B CN201710186977.0A CN201710186977A CN107044857B CN 107044857 B CN107044857 B CN 107044857B CN 201710186977 A CN201710186977 A CN 201710186977A CN 107044857 B CN107044857 B CN 107044857B
Authority
CN
China
Prior art keywords
laser radar
transmission gear
shaft
laser
main shaft
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.)
Active
Application number
CN201710186977.0A
Other languages
English (en)
Other versions
CN107044857A (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.)
Heilongjiang Fangzhen Technology Co.,Ltd.
Original Assignee
Heilongjiang Silicon Robot 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 Heilongjiang Silicon Robot Co Ltd filed Critical Heilongjiang Silicon Robot Co Ltd
Priority to CN201710186977.0A priority Critical patent/CN107044857B/zh
Publication of CN107044857A publication Critical patent/CN107044857A/zh
Application granted granted Critical
Publication of CN107044857B publication Critical patent/CN107044857B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • G01C21/32Structuring or formatting of map data
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

应用于服务机器人的异步式地图构建与定位系统及方法,属于机器人导航技术领域。解决了现有周围环境感知的技术易受到光线,湿度等物理环境因素的影响,适用范围小且成本较高的问题。本发明的基座的中空结构内设有横向的圆形隔板,2D激光雷达驱动电机设置在圆形隔板的下侧,外轴角度编码器用于采集2D激光雷达驱动电机的转速,一号传动齿轮套设在2D激光雷达驱动电机的转动轴上,一号传动齿轮与三号传动齿轮咬合,三号传动齿轮套设在旋转主轴外轴的外侧,旋转主轴外轴与旋转主轴内轴同轴设置,且所述旋转主轴外轴的顶端与2D激光雷达固定连接,旋转主轴内轴穿过2D激光雷达与3D激光雷达的下表面固定连接。本发明适用于机器人导航高精度定位使用。

Description

应用于服务机器人的异步式地图构建与定位系统及方法
技术领域
本发明属于机器人导航技术领域。
背景技术
激光导航是利用激光直线性好,发散角小、能量集中等特点进行多点位精准测量,通过对数据的组合运算,计算出设备的相对位置,从而实现定位。激光导航的方式有很多,但是目前较为成熟且广泛应用的激光导航技术主要有两种,一种为利用激光反射板进行定位,激光发射器发射的激光经过反射板反射被接收器接收,通过测算不同位置的反射板的位置来确定设备的当前位置,并且利用相关的数学模型做导航指引,特点是精度较高,但是无法感知周围环境需要其他传感器辅助感应且使用前需要进行反射板的安装,前期施工量大;另外一种则无需使用反射板,利用设备所在环境中的障碍物作为参照物通过利用2D激光扫描周围环境中的障碍物获得相关数据,在通过对数据的处理整合构建出设备周围的二维虚拟地图,地图构建后设备在运动时,不断比对周围的障碍物数据,从而获取相关的地理位置信息,通过相关的数学模型,得出具体性运动控制数据,特点是施工难度低,易于使用,但是缺点是精度较低,扫描数据为环境的一个截面,无法感知其他高度的环境数据,需要其他传感器进行辅助感应。
目前可以达到周围环境感知的技术主要是视觉感知及3D激光雷达方案,但是视觉技术目前易受到光线,湿度等物理环境因素的影响适用范围小成本较高;符合导航使用的高精度的3D激光雷达方案目前市场价格都极为昂贵,成本高出太多,在应用于服务机器人行业并不成熟,并且开发难度较大。
发明内容
本发明是为了解决现有周围环境感知的技术易受到光线,湿度等物理环境因素的影响,适用范围小且成本较高的问题;提出了一种应用于服务机器人的异步式地图构建与定位系统及方法。
本发明所述的应用于服务机器人的异步式地图构建与定位系统,它包括基座1、2D激光雷达2、3D激光雷达3、板卡4、一号传动齿轮5、2D激光雷达驱动电机6、外轴角度编码器7、二号传动齿轮8、3D激光雷达驱动电机9、内轴角度编码器10、旋转主轴外轴11、旋转主轴内轴12、三号传动齿轮14和四号传动齿轮13;
基座1为中空结构的柱体,沿基座1的柱面开有矩形扫描口,2D激光雷达2设置在所述矩形扫描口内;基座1的顶端为中空的圆台形结构,所述3D激光雷达3设置在所述圆台形结构内,3D激光雷达3设置在2D激光雷达2的上侧;
一号传动齿轮5、2D激光雷达驱动电机6、外轴角度编码器7、二号传动齿轮8、3D激光雷达驱动电机9、内轴角度编码器10、三号传动齿轮14和四号传动齿轮13均设置在基座1的中空结构内;
基座1的中空结构内设有横向的圆形隔板,2D激光雷达驱动电机6设置在圆形隔板的下侧,外轴角度编码器7用于采集2D激光雷达驱动电机6的转速,一号传动齿轮5套设在2D激光雷达驱动电机6的转动轴上,一号传动齿轮5与三号传动齿轮14咬合,三号传动齿轮14套设在旋转主轴外轴11的外侧,旋转主轴外轴11与旋转主轴内轴12同轴设置,且所述旋转主轴外轴11的顶端与2D激光雷达2固定连接,旋转主轴内轴12穿过2D激光雷达2与3D激光雷达3的下表面固定连接,且旋转主轴内轴12与2D激光雷达2之间设有缝隙;旋转主轴内轴12与旋转主轴外轴11之间设有缝隙,旋转主轴外轴11的底端固定在隔板上;
四号传动齿轮13套设在旋转主轴内轴12的外侧,二号传动齿轮8套接在3D激光雷达驱动电机9的转动轴上,内轴角度编码器10用于采集3D激光雷达驱动电机9的转速;2D激光雷达2用于采集自身安装平面内的环境信息,3D激光雷达3用于扫描自身所在水平面向上夹角为0°~45°范围内的环境信息;
板卡4设置在基座1的侧面,所述板卡4用于安装板卡电源电路41、2D激光雷达数据处理器42、电机驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45;
板卡电源电路41用于为2D激光雷达数据处理器42、电机驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45供电;
电机驱动控制器43的一个控制信号输出端连接2D激光雷达驱动电机6的控制信号输入端,电机驱动控制器43的另一个控制信号输出端连接3D激光雷达驱动电机9的控制信号输入端;
编码器数据处理器44的内轴转速信号输入端连接内轴角度编码器10转速信号输出端,编码器数据处理器44的外轴转速信号输入端连接外轴角度编码器7转速信号输出端;
2D激光雷达2的扫描信号输出端连接2D激光雷达数据处理器42的环境数据信号输入端;
3D激光雷达3的扫描信号输出端连接3D激光雷达数据处理器45的环境数据信号输入端。
应用于服务机器人的异步式地图构建与定位方法,该方法的具体步骤为:
步骤一、采用2D激光雷达驱动电机6和3D激光雷达驱动电机9分别带动2D激光雷达2、3D激光雷达3在不同水平面内旋转,且2D激光雷达2位于3D激光雷达3的下侧;且2D激光雷达2的转动轴与3D激光雷达3的转动轴同轴;
步骤二、采用内轴角度编码器10采集3D激光雷达驱动电机9的转角获得3D激光雷达3的转速,采用外轴角度编码器7采集2D激光雷达2的转速,3D激光雷达3和2D激光雷达2都将转速信号传递给编码器数据处理器44;
步骤三、采用2D激光雷达2扫描自身安装平面内的环境信息,采用3D激光雷达3扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;
2D激光雷达2扫描自身所在平面的区域,且2D激光雷达2的扫描区域与3D激光雷达3的扫描区域互不重叠;
步骤四、对编码器数据处理器44接收到的2D激光雷达2的转速与2D激光雷达2扫描机器人周围环境的障碍物信息进行数据组合;
对3D激光雷达3的转速与3D激光雷达3扫描机器人斜向上0°~45°范围内环境信息进行数据组合;
步骤五、采用基于特征提取的SLAM算法实现对3D激光雷达3扫描的环境信息与2D激光雷达2扫描的环境信息进行对应处理,实现对服务机器人周围环境地图的构建与定位。
本发明采用2D、3D激光雷达的驱动电机在带动旋转主轴旋转时,根据精度要求可匹配不同转速的电机及齿轮传动组,在测算出电机转速后经过比例换算得出激光扫描的系统的转动速度,同时根据角度检测编码器的输出数据来确定激光扫描系统的偏转角度。编码器选型根据齿轮传动比选择单圈或者多圈。本发明的优点为:结构简单,成本低廉,可靠性高,可满足室内型服务机器人的导航定位要求,且本发明所述的结构与现有周围环境感知系统相比异步式地图构建与定位系统的存在定位精度高的有点。
附图说明
图1为发明所述应用于服务机器人的异步式地图构建与定位系统的结构示意图;
图2为具体实施方式一所述的2D激光雷达与3D激光雷达的安装位置示意图;
图3为具体实施方式一所述的应用于服务机器人的异步式地图构建与定位系统的原理框图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
具体实施方式一、结合图1至图3说明本实施方式,本实施方式所述的应用于服务机器人的异步式地图构建与定位系统,它包括基座1、2D激光雷达2、3D激光雷达3、板卡4、一号传动齿轮5、2D激光雷达驱动电机6、外轴角度编码器7、二号传动齿轮8、3D激光雷达驱动电机9、内轴角度编码器10、旋转主轴外轴11、旋转主轴内轴12、三号传动齿轮14和四号传动齿轮13;
基座1为中空结构的柱体,沿基座1的柱面开有矩形扫描口,2D激光雷达2设置在所述矩形扫描口内;基座1的顶端为中空的圆台形结构,所述3D激光雷达3设置在所述圆台形结构内,3D激光雷达3设置在2D激光雷达2的上侧;
一号传动齿轮5、2D激光雷达驱动电机6、外轴角度编码器7、二号传动齿轮8、3D激光雷达驱动电机9、内轴角度编码器10、三号传动齿轮14和四号传动齿轮13均设置在基座1的中空结构内;
基座1的中空结构内设有横向的圆形隔板,2D激光雷达驱动电机6设置在圆形隔板的下侧,外轴角度编码器7用于采集2D激光雷达驱动电机6的转速,一号传动齿轮5套设在2D激光雷达驱动电机6的转动轴上,一号传动齿轮5与三号传动齿轮14咬合,三号传动齿轮14套设在旋转主轴外轴11的外侧,旋转主轴外轴11与旋转主轴内轴12同轴设置,且所述旋转主轴外轴11的顶端与2D激光雷达2固定连接,旋转主轴内轴12穿过2D激光雷达2与3D激光雷达3的下表面固定连接,且旋转主轴内轴12与2D激光雷达2之间设有缝隙;旋转主轴内轴12与旋转主轴外轴11之间设有缝隙,旋转主轴外轴11的底端固定在隔板上;
四号传动齿轮13套设在旋转主轴内轴12的外侧,二号传动齿轮8套接在3D激光雷达驱动电机9的转动轴上,内轴角度编码器10用于采集3D激光雷达驱动电机9的转速;2D激光雷达2用于采集自身安装平面内的环境信息,3D激光雷达3用于扫描自身所在水平面向上夹角为0°~45°范围内的环境信息;
板卡4设置在基座1的侧面,所述板卡4用于安装板卡电源电路41、2D激光雷达数据处理器42、电机驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45;
板卡电源电路41用于为2D激光雷达数据处理器42、电机驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45供电;
电机驱动控制器43的一个控制信号输出端连接2D激光雷达驱动电机6的控制信号输入端,电机驱动控制器43的另一个控制信号输出端连接3D激光雷达驱动电机9的控制信号输入端;
编码器数据处理器44的内轴转速信号输入端连接内轴角度编码器10转速信号输出端,编码器数据处理器44的外轴转速信号输入端连接外轴角度编码器7转速信号输出端;
2D激光雷达2的扫描信号输出端连接2D激光雷达数据处理器42的环境数据信号输入端;
3D激光雷达3的扫描信号输出端连接3D激光雷达数据处理器45的环境数据信号输入端。
本实施方式所述的3D激光雷达在上方扫描的一定范围的空间环境,其反馈数据用于构建整个环境地图,两种雷达各自独立运行,互不干扰,该结构为异步结构,扫描转动速度可根据需要分别设置,当扫描系统工作旋转时,3D激光雷达及2D激光雷达均旋转,但是转速不同,3D激光雷达旋转频率要求调控范围在5-10Hz范围内;2D激光雷达旋转频率要求调控范围在10-20Hz范围内。3D激光雷达与2D激光雷达扫描区域互不重叠,防止互相干扰。由2个同心旋转主轴带动3D激光雷达和2D激光雷达进行旋转。3D激光雷达与基座的输出轴内轴即旋转主轴内轴连接,旋转主轴内轴再通过传动齿轮与带有内轴角度编码器的3D激光驱动电机连接,传动齿轮中连接旋转主轴内轴及3D激光驱动电机的齿轮比例为1:1,内轴角度编码器为单圈绝对值编码器,电机性能匹配标准为输出旋转主轴的转动分辨率≤1°,驱动电机的选用标准为转动平稳,不同速度要求下均有稳定的转速表现。2D激光雷达与基座的输出轴外轴即旋转主轴外轴连接,旋转主轴外轴再通过一号传动齿轮与2D激光驱动电机及外轴角度编码器连接,齿轮传动中连接旋转主轴内轴及2D激光驱动电机的齿轮比例为1:1,外轴角度编码器为单圈绝对值编码器电机性能匹配标准为输出旋转主轴的转动分辨率≤1°,驱动电机的选用标准为转动平稳,不同速度要求下均有稳定的转速表现。
当设备工作时,先对2D、3D激光雷达进行运行参数设定例如转动频率,3D激光雷达与2D激光雷达均开始数据输出,3D激光雷达单次扫描为一个空间纵向截面数据,旋转360°后则获得了设备周围整个空间的纵向截面数据,通过算法对获得数据排布融合获得周围空间环境数据,从而构建出整个周围空间的地图数据,2D激光雷达单次扫描为设备所在环境的一个横向截面的一个点位数据,旋转360°后则获得所在横向截面的所有数据,通过算法进行数据融合后,获得所在环境2D激光雷达所在环境的位置。从而实现机器人的定位。根据环境地图及定位数据通过算法设定出机器人运行到目标点的轨迹来实现导航。
具体实施方式二、本实施方式是对具体实施方式一所述的应用于服务机器人的异步式地图构建与定位系统的进一步说明,二号传动齿轮8和四号传动齿轮13的比例为1:1。
具体实施方式三、本实施方式是对具体实施方式一或二所述的应用于服务机器人的异步式地图构建与定位系统的进一步说明,3D激光雷达3包括表面透镜、线性激光发射器、CMOS感光原件和偏光镜;
表面透镜嵌固在基座1顶端的圆台形结构上,线性激光发射器、CMOS感光原件和偏光镜均设置在基座1的圆台形结构内;
线性激光发射器的激光信号经表面透镜发射至3D激光雷达3所旋转的环境中,线性激光发射器的激光信号遇到障碍物后的反射光再次经表面透镜入射至偏光镜,所述反射光经偏光镜后入射至CMOS感光原件的感光面上,所述CMOS感光原件的信号输出端连接3D激光雷达数据处理器45的的环境数据信号输入端。
本实施方式所述的线性激光发射器向扫描区域发射一条线状激光,该激光线平行于3D激光扫描仪转轴,垂直于3D激光扫描仪转动平面,激光线打到障碍物后会产生反射,反射后的激光线经过透镜及偏光镜被COMS感光元件组接收,利用COMS感光元件组接收的位置偏差数值通过三角测距法计算出障碍物距离。
详细过程:
结构:激光发射器的发射方向与发射平台所在平面呈一定的夹角θ,COMS感光元件组与偏光镜平行且与发射平台所在平面平行,
组件作用:
线性激光发射器:向检测区域发射一条平行于3D激光扫描仪转轴,垂直于3D激光扫描仪转动平面的激光线用于测量。
透镜:仅保留激光器发射波长的光线进入,从而可以一定程度的避免光线干扰
偏光镜:用来吸收天空中的偏振光,水面的反光,玻璃反光等非金属反光避免光线干扰。
COMS感光元件组:接收反射激光线并测量出与中心偏差数据。(如不好理解可参考COMS摄像头)
过程:
a)线性激光发射器发射出一条固定波长的垂直激光线,激光线照射到检测区域的障碍物(墙体、物体等)并形成反射。由于障碍物的表面不同高度距离发射器远近不同,反射后的激光线就会产生扭曲而变形。
b)反射后扭曲的激光线通过透镜及偏光镜被CMOS感光元件组接收,由于在自然界中有很多波段的光线会对激光产生干扰,经过透镜及偏光镜后会滤除很多杂光,净化接收光线。
c)扭曲的激光线,被CMOS接收时由于扭曲的程度不同,在CMOS感光元件组上的成像也不同,也就能够形成与中轴线不同距离的多像素点图像。
d)激光线在整个发射-反射-接收过程中障碍物的不同高度位置是与CMOS成像不同位置的点对应的。
e)先计算成像中单点的距离检测问题,利用感光元件组的成像点偏差数据及激光发射角度θ,激光发射器中心与CMOS中心的距离,CMOS调制出的焦距等通过三角测距法计算出障碍物单点距离。
f)然后在计算高度坐标系不同位置的激光数据,得出障碍物其他点距离数据,全部计算完后得出的就是3D激光扫描系统,在该方向的所有纵向数据。
g)最后,3D激光扫描系统,根据转动分度依次旋转。将所有方向即360°方向的所有数据均计算完成后,即可得出周围环境的所有距离数据。将数据汇总,便是周围环境信息。
具体实施方式四、本实施方式所述应用于服务机器人的异步式地图构建与定位方法,该方法的具体步骤为:
步骤一、采用2D激光雷达驱动电机6和3D激光雷达驱动电机9分别带动2D激光雷达2、3D激光雷达3在不同水平面内旋转,且2D激光雷达2位于3D激光雷达3的下侧;且2D激光雷达2的转动轴与3D激光雷达3的转动轴同轴;
步骤二、采用内轴角度编码器10采集3D激光雷达驱动电机9的转角获得3D激光雷达3的转速,采用外轴角度编码器7采集2D激光雷达2的转速,3D激光雷达3和2D激光雷达2都将转速信号传递给编码器数据处理器44;
步骤三、采用2D激光雷达2扫描自身安装平面内的环境信息,采用3D激光雷达3扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;
2D激光雷达2扫描自身所在平面的区域,且2D激光雷达2的扫描区域与3D激光雷达3的扫描区域互不重叠;
步骤四、对编码器数据处理器44接收到的2D激光雷达2的转速与2D激光雷达2扫描机器人周围环境的障碍物信息进行数据组合;
对3D激光雷达3的转速与3D激光雷达3扫描机器人斜向上0°~45°范围内环境信息进行数据组合;
步骤五、采用基于特征提取的SLAM算法实现对3D激光雷达3扫描的环境信息与2D激光雷达2扫描的环境信息进行对应处理,实现对服务机器人周围环境地图的构建与定位。
实施例:
3D激光雷达驱动电机选用直流伺服电机额定转速为600n/min,2D激光雷达驱动电机选用直流伺服电机额定转速为2400n/min,驱动电机与旋转主轴外轴的传动速比为1:1,驱动电机与旋转主轴内轴的传动速比为1:1,2D、3D角度检测编码器选用单圈绝对值编码器,2D激光雷达采用TOF测距法激光雷达,3D激光雷达采用线性激光发射器与COMS感光元件组、偏光镜组成的三角测距法激光雷达。设备上电后,对基座内部板卡进行供电,给与3D激光雷达驱动电机5Hz转速的控制指令,数据处理系统将5Hz的控制指令转换成50%占空比的PWM驱动电机控制性号,控制3D激光雷达驱动电机以300n/min的转速即5hz转动频率稳定转动,通过1:1的齿轮传动组,控制旋转主轴内轴以5Hz转动,旋转主轴内轴带动3D激光雷达以5Hz的转动频率转动。给与2D激光雷达驱动电机20Hz转速的控制指令,数据处理系统将20Hz的控制指令转换成50%占空比的PWM驱动电机控制性号,控制3D激光雷达驱动电机以1200n/min的转速即20hz转动频率稳定转动,通过1:1的齿轮传动,控制旋转主轴内轴以20Hz转动,旋转主轴内轴带动3D激光雷达以20Hz的转动频率转动。2D、3D激光雷达开始获取周围环境的测距信息,分别通过各自的数据采集板进行数据纠偏处理,将处理后的数据传输给基座内部的数据处理系统,数据处理系统将3D激光雷达获取到的单个位置的纵向截面数据结合绝对值编码器给出的角度信息组合成一组数据,该组数据为本系统在该位置该方向的环境信息,连续旋转一周得到的每一组数据均做数据组合,所得到的数据组为本系统所在环境的环境距离信息,在经过算法融合构建出设备周围的环境地图信息。同时数据处理系统将高精度2D激光雷达获取到的单个位置的数据结合绝对值编码器给出的角度信息组合成一组数据,该组数据为本系统在该位置该方向2D激光雷达高度的横向截面中的测距数据,连续旋转一周后获得的所有数据均做此处理,所得到的数据组为本系统所在环境的2D激光雷达高度的横向截面距离信息,经过SLAM算法等数学模型的换算融合的到本系统所在环境的位置信息。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,一体地连接,也可以是可拆卸连接;可以是两个元件内部的连通;可以是直接相连,也可以通过中间媒介间接相连,对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

Claims (3)

1.应用于服务机器人的异步式地图构建与定位系统,其特征在于,它包括基座(1)、2D激光雷达(2)、3D激光雷达(3)、板卡(4)、一号传动齿轮(5)、2D激光雷达驱动电机(6)、外轴角度编码器(7)、二号传动齿轮(8)、3D激光雷达驱动电机(9)、内轴角度编码器(10)、旋转主轴外轴(11)、旋转主轴内轴(12)、三号传动齿轮(14)和四号传动齿轮(13);
基座(1)为中空结构的柱体,沿基座(1)的柱面开有矩形扫描口, 2D激光雷达(2)设置在所述矩形扫描口内;基座(1)的顶端为中空的圆台形结构,所述3D激光雷达(3)设置在所述圆台形结构内,3D激光雷达(3)设置在2D激光雷达(2)的上侧;
一号传动齿轮(5)、2D激光雷达驱动电机(6)、外轴角度编码器(7)、二号传动齿轮(8)、3D激光雷达驱动电机(9)、内轴角度编码器(10)、三号传动齿轮(14)和四号传动齿轮(13)均设置在基座(1)的中空结构内;
基座(1)的中空结构内设有横向的圆形隔板,2D激光雷达驱动电机(6)设置在圆形隔板的下侧,外轴角度编码器(7)用于采集2D激光雷达驱动电机(6)的转速,一号传动齿轮(5)套设在2D激光雷达驱动电机(6)的转动轴上,一号传动齿轮(5)与三号传动齿轮(14)咬合,三号传动齿轮(14)套设在旋转主轴外轴(11)的外侧,旋转主轴外轴(11)与旋转主轴内轴(12)同轴设置,且所述旋转主轴外轴(11)的顶端与2D激光雷达(2)固定连接,旋转主轴内轴(12)穿过2D激光雷达(2)与3D激光雷达(3)的下表面固定连接,且旋转主轴内轴(12)与2D激光雷达(2)之间设有缝隙;旋转主轴内轴(12)与旋转主轴外轴(11)之间设有缝隙,旋转主轴外轴(11)的底端固定在隔板上;
四号传动齿轮(13)套设在旋转主轴内轴(12)的外侧,二号传动齿轮(8)套接在3D激光雷达驱动电机(9)的转动轴上,内轴角度编码器(10)用于采集3D激光雷达驱动电机(9)的转速;2D激光雷达(2)用于采集自身安装平面内的环境信息, 3D激光雷达(3)用于扫描自身所在平面向上夹角为0°~45°范围内的环境信息;
板卡(4)设置在基座(1)的侧面,所述板卡(4)用于安装板卡电源电路(41)、2D激光雷达数据处理器(42)、电机驱动控制器(43)、编码器数据处理器(44)和3D激光雷达数据处理器(45);
板卡电源电路(41)用于为2D激光雷达数据处理器(42)、电机驱动控制器(43)、编码器数据处理器(44)和3D激光雷达数据处理器(45)供电;
电机驱动控制器(43)的一个控制信号输出端连接2D激光雷达驱动电机(6)的控制信号输入端,电机驱动控制器(43)的另一个控制信号输出端连接3D激光雷达驱动电机(9)的控制信号输入端;
编码器数据处理器(44)的内轴转速信号输入端连接内轴角度编码器(10)转速信号输出端,编码器数据处理器(44)的外轴转速信号输入端连接外轴角度编码器(7)转速信号输出端;
2D激光雷达(2)的扫描信号输出端连接2D激光雷达数据处理器(42)的环境数据信号输入端;
3D激光雷达(3)的扫描信号输出端连接3D激光雷达数据处理器(45)的环境数据信号输入端;
2D激光雷达(2)和3D激光雷达(3)各自独立运行,互不干扰,构成异步结构,扫描转动速度根据需要分别设置;当扫描系统工作旋转时,3D激光雷达(3)及2D激光雷达(2)均旋转,但是转速不同;2D激光雷达(2)与3D激光雷达(3)扫描区域互不重叠。
2.根据权利要求1所述的应用于服务机器人的异步式地图构建与定位系统,其特征在于,二号传动齿轮(8)和四号传动齿轮(13)的比例为1:1。
3.根据权利要求1或2所述的应用于服务机器人的异步式地图构建与定位系统,其特征在于,3D激光雷达(3)包括表面透镜、线性激光发射器、CMOS感光元件和偏光镜;
表面透镜嵌固在基座(1)顶端的圆台形结构上,线性激光发射器、CMOS感光元件和偏光镜均设置在基座(1)的圆台形结构内;
线性激光发射器的激光信号经表面透镜发射至3D激光雷达(3)所旋转的环境中,线性激光发射器的激光信号遇到障碍物后的反射光再次经表面透镜入射至偏光镜,所述反射光经偏光镜后入射至CMOS感光元件的感光面上,所述CMOS感光元件的信号输出端连接3D激光雷达数据处理器(45)的环境数据信号输入端。
CN201710186977.0A 2017-03-24 2017-03-24 应用于服务机器人的异步式地图构建与定位系统及方法 Active CN107044857B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710186977.0A CN107044857B (zh) 2017-03-24 2017-03-24 应用于服务机器人的异步式地图构建与定位系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710186977.0A CN107044857B (zh) 2017-03-24 2017-03-24 应用于服务机器人的异步式地图构建与定位系统及方法

Publications (2)

Publication Number Publication Date
CN107044857A CN107044857A (zh) 2017-08-15
CN107044857B true CN107044857B (zh) 2020-02-07

Family

ID=59545567

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710186977.0A Active CN107044857B (zh) 2017-03-24 2017-03-24 应用于服务机器人的异步式地图构建与定位系统及方法

Country Status (1)

Country Link
CN (1) CN107044857B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019136719A1 (zh) 2018-01-12 2019-07-18 浙江国自机器人技术有限公司 一种智能洗地机器人
CN108354533A (zh) * 2018-01-12 2018-08-03 浙江国自机器人技术有限公司 一种智能洗地机器人
CN108196550A (zh) * 2018-02-08 2018-06-22 广东工业大学 一种自动导向小车及其自动控制方法
CN110955246A (zh) * 2019-12-12 2020-04-03 深圳乐动机器人有限公司 清洁机器人
CN111044982B (zh) * 2019-12-23 2021-09-28 广东纳睿雷达科技股份有限公司 一种雷达方位定位的方法
CN111983638B (zh) * 2020-08-20 2023-12-15 美智纵横科技有限责任公司 一种激光雷达和具有清洁功能的设备
CN112034484B (zh) * 2020-09-02 2023-04-11 亿嘉和科技股份有限公司 一种基于半球形激光雷达的建模系统及其方法
CN117428790B (zh) * 2023-12-19 2024-02-23 四川吉埃智能科技有限公司 一种机器人避障检测装置及方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103257342B (zh) * 2013-01-11 2014-11-05 大连理工大学 三维激光传感器与二维激光传感器的联合标定方法
CN104808192A (zh) * 2015-04-15 2015-07-29 中国矿业大学 进行三维激光扫描的摆动装置及其坐标转换方法
WO2016207669A2 (en) * 2015-06-23 2016-12-29 Oxford University Innovation Limited A method of generating a three dimensional representation of an environment or system
CN105068085B (zh) * 2015-07-27 2017-08-29 中国科学技术大学 高精度单电机传动激光雷达三维扫描仪
CN105676209B (zh) * 2016-04-01 2023-02-24 山东理工大学 一种直升机载激光雷达平台三维姿态角复杂振动实时补偿方法与装置
CN105891839B (zh) * 2016-04-02 2018-04-27 上海大学 一种具有彩色点云获取能力的全向激光雷达装置

Also Published As

Publication number Publication date
CN107044857A (zh) 2017-08-15

Similar Documents

Publication Publication Date Title
CN107044857B (zh) 应用于服务机器人的异步式地图构建与定位系统及方法
CN106886030B (zh) 应用于服务机器人的同步式地图构建与定位系统及方法
KR102641651B1 (ko) 멀티 라인 레이저 레이더
Liu et al. Low-cost retina-like robotic lidars based on incommensurable scanning
CN206331180U (zh) 一种具有空心轴的激光扫描装置
CN108398696A (zh) 多线旋转式激光雷达装置
CN101320094B (zh) 一种光源扫描定位系统及其定位方法
CN105093237A (zh) 一种无人机用障碍物检测装置及其检测方法
CN103278808A (zh) 一种多线扫描式激光雷达装置
CN106772314B (zh) 一种机载测绘激光雷达扫帚式扫描系统及其扫描方法
CN103477185A (zh) 用于确定对象表面的3d坐标的测量系统
CN104296655B (zh) 一种激光跟踪仪像旋公式初始角的标定方法
CN107643525A (zh) 基于45°转镜的线阵激光雷达周向无像旋成像系统
CN101493526A (zh) 月球车高速三维激光成像雷达系统以及成像方法
CN108983197A (zh) 基于mems微镜的三维扫描激光雷达
CN101852607A (zh) 旋转式激光视觉线阵空间识别定位系统
CN108572369A (zh) 一种微镜扫描探测装置及探测方法
CN109490909A (zh) 激光雷达扫描探测装置及其探测方法
CN113960566A (zh) 一种3d激光雷达及足式机器人
CN112882052A (zh) 一种空间交会对接的激光雷达
CN111948667A (zh) 三维扫描系统
CN210534336U (zh) 一种激光雷达
CN208156197U (zh) 多线旋转式激光雷达装置
CN110231607A (zh) 一种基于高集成度的专用soc芯片的激光雷达系统
CN205562803U (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
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20200604

Address after: Room 1160, 11th floor, 118 xidazhi street, Nangang District, Harbin City, Heilongjiang Province

Patentee after: Heilongjiang Fangzhen Technology Co.,Ltd.

Address before: 150000, 701, Wang Yang building, 380 Changjiang Road, Nangang District, Harbin City, Heilongjiang Province

Patentee before: HEILONGJIANG GUIZHI THE ROBOT Co.,Ltd.