CN106886030A - 应用于服务机器人的同步式地图构建与定位***及方法 - Google Patents
应用于服务机器人的同步式地图构建与定位***及方法 Download PDFInfo
- Publication number
- CN106886030A CN106886030A CN201710186978.5A CN201710186978A CN106886030A CN 106886030 A CN106886030 A CN 106886030A CN 201710186978 A CN201710186978 A CN 201710186978A CN 106886030 A CN106886030 A CN 106886030A
- Authority
- CN
- China
- Prior art keywords
- laser
- laser radars
- angle
- radars
- encoder
- 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
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 18
- 238000000034 method Methods 0.000 title claims abstract description 14
- 230000007613 environmental effect Effects 0.000 claims abstract description 38
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims abstract description 31
- 238000001514 detection method Methods 0.000 claims abstract description 20
- 238000009434 installation Methods 0.000 claims abstract description 9
- 241001269238 Data Species 0.000 claims description 19
- 230000004888 barrier function Effects 0.000 claims description 11
- 230000005540 biological transmission Effects 0.000 claims description 8
- 230000003287 optical effect Effects 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 4
- 230000004807 localization Effects 0.000 claims description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 2
- 238000007689 inspection Methods 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 7
- 230000008447 perception Effects 0.000 abstract description 2
- 230000004927 fusion Effects 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000001276 controlling effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 230000006698 induction Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 206010052128 Glare Diseases 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000004438 eyesight Effects 0.000 description 1
- 230000004313 glare Effects 0.000 description 1
- 239000011521 glass Substances 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 238000000746 purification Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/87—Combinations of systems using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0248—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Optics & Photonics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
应用于服务机器人的同步式地图构建与定位***及方法,属于机器人导航技术领域。解决了现有周围环境感知的技术易受到光线,湿度等物理环境因素的影响,适用范围小且成本较高的问题。本发明所述的旋转主轴位于基座的中心,角度检测编码器用于采集旋转主轴的转速;驱动电机通过齿轮组带动旋转主轴和角度检测编码器旋转;旋转主轴的顶端套接在传动轴承的轴套内,所述传动轴承位于基座的顶端,传动轴承带动3D激光雷达和2D激光雷达同时旋转,2D激光雷达用于采集所安装平面内的环境信息,3D激光雷达用于扫描自身安装水平面向上夹角为0°~45°范围内的环境信息,板卡设置在基座内。本发明适用于机器人导航定位技术使用。
Description
技术领域
本发明属于机器人导航技术领域。
背景技术
激光导航是利用激光直线性好,发散角小、能量集中等特点进行多点位精准测量,通过对数据的组合运算,计算出设备的相对位置,从而实现定位。激光导航的方式有很多,但是目前较为成熟且广泛应用的激光导航技术主要有两种,一种为利用激光反射板进行定位,激光发射器发射的激光经过反射板反射被接收器接收,通过测算不同位置的反射板的位置来确定设备的当前位置,并且利用相关的数学模型做导航指引,特点是精度较高,但是无法感知周围环境需要其他传感器辅助感应且使用前需要进行反射板的安装,前期施工量大;另外一种则无需使用反射板,利用设备所在环境中的障碍物作为参照物通过利用2D激光扫描周围环境中的障碍物获得相关数据,在通过对数据的处理整合构建出设备周围的二维虚拟地图,地图构建后设备在运动时,不断比对周围的障碍物数据,从而获取相关的地理位置信息,通过相关的数学模型,得出具体性运动控制数据,特点是施工难度低,易于使用,但是缺点是精度较低,扫描数据为环境的一个截面,无法感知其他高度的环境数据,需要其他传感器进行辅助感应。
目前可以达到周围环境感知的技术主要是视觉感知及3D激光雷达方案,但是视觉技术目前易受到光线,湿度等物理环境因素的影响适用范围小成本较高;符合导航使用的高精度的3D激光雷达方案目前市场价格都极为昂贵,成本高出太多,在应用于服务机器人行业并不成熟,并且开发难度较大。
发明内容
本发明是为了解决现有周围环境感知的技术易受到光线,湿度等物理环境因素的影响,适用范围小且成本较高的问题;提出了一种应用于服务机器人的同步式地图构建与定位***及方法。
本发明所述的应用于服务机器人的同步式地图构建与定位***,它包括3D激光雷达1、2D激光雷达2、传动轴承3、板卡4、旋转主轴5、角度检测编码器6、齿轮传动组7、驱动电机8和基座9;
基座9下部为中空结构的柱体,上部为中空结构的圆台形,所述圆台形为上下均开口结构;
齿轮传动组7包括三个齿轮,所述三个齿轮均设置在基座9的底部,且三个齿轮依次咬合,三个齿轮分别套设在驱动电机8的转动轴的外侧、旋转主轴5的外侧和角度检测编码器6下侧所固定的传动轴的外侧;旋转主轴5位于基座9的中心,角度检测编码器6用于采集旋转主轴5的转速;
驱动电机8通过齿轮传动组7带动旋转主轴5和角度检测编码器6旋转;旋转主轴5的顶端套接在传动轴承3的轴套内,所述传动轴承3位于基座9的顶端,传动轴承3带动3D激光雷达1和2D激光雷达2同时旋转,所述2D激光雷达2位于3D激光雷达1的下侧;2D激光雷达2用于扫描自身安装平面内的环境信息,3D激光雷达1扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;
板卡4设置在基座9内,所述板卡4用于安装板卡电源电路41、2D激光雷达数据处理器42、电极驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45;
板卡电源电路41用于为2D激光雷达数据处理器42、电极驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45供电;
2D激光雷达数据处理器42的环境信号输入端连接2D激光雷达2的扫描信号输出端,
电机驱动控制器(43)的控制信号输出端驱动电机8的控制信号输入端,
编码器数据处理器44的角度信号输入端连接角度检测编码器6角度信号输出端;
3D激光雷达1的扫描信号输出端连接3D激光雷达数据处理器45的环境数据信号输入端。
应用于服务机器人的异步式地图构建与定位方法,该方法的具体步骤为:
步骤一、采用驱动电机8通过齿轮传动组7带动旋转主轴5和角度检测编码器6旋转;将2D激光雷达2和3D激光雷达1通过传动轴承3安装在旋转主轴5的顶端;
步骤二、角度检测编码器6对2D激光雷达2和3D激光雷达1的所连接的旋转主轴5的转速进行检测;并将检测信息发送至编码器数据处理器44;
步骤三、采用2D激光雷达2扫描自身所在平面环境信息,采用3D激光雷达1扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;2D激光雷达2扫描自身安装平面内的环境信息,且2D激光雷达2的扫描区域与3D激光雷达1的扫描区域互不重叠;
步骤四、对编码器数据处理器44接收到的2D激光雷达2和3D激光雷达1的转速信息与2D激光雷达2扫描机器人周围环境的障碍物信息和3D激光雷达1扫描自身安装水平面向上夹角为0°~45°范围内的环境信息进行数据组合;
步骤五、采用基于特征提取的SLAM算法实现对3D激光雷达1扫描的环境信息与2D激光雷达2扫描的环境信息进行对应处理,实现对服务机器人周围环境地图的构建与定位。
本发明的技术方案的激光扫描***包含一个低成本3D激光雷达,一个高精度2D激光雷达。在该***中驱动电机通过齿轮传动组与旋转主轴连接,旋转主轴直接连接激光扫描***,通过控制驱动电机转动来带动激光扫描***旋转,在激光扫描***中包含3D激光雷达及2D激光雷达,两种雷达为分层排布一体化结构,以达到互不干扰及同步转动的同频同速效果。
驱动电机在带动旋转主轴旋转时,根据精度要求可匹配不同速比的齿轮传动组,在测算出电机转速后经过比例换算得出激光扫描的***的转动速度,同时根据角度检测编码器的输出数据来确定激光扫描***的偏转角度。且本发明结构简单,成本低廉,可靠性高,可满足室内型服务机器人的导航定位要求。
附图说明
图1为发明所述应用于服务机器人的同步式地图构建与定位***的结构示意图;
图2为具体实施方式一所述的2D激光雷达与3D激光雷达的安装位置示意图;
图3为具体实施方式一所述的应用于服务机器人的同步式地图构建与定位***的原理框图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
具体实施方式一、结合图1至图3说明本实施方式,本实施方式所述的应用于服务机器人的同步式地图构建与定位***,它包括3D激光雷达1、2D激光雷达2、传动轴承3、板卡4、旋转主轴5、角度检测编码器6、齿轮传动组7、驱动电机8和基座9;
基座9下部为中空结构的柱体,上部为中空结构的圆台形,所述圆台形为上下均开口结构;
齿轮传动组7包括三个齿轮,所述三个齿轮均设置在基座9的底部,且三个齿轮依次咬合,三个齿轮分别套设在驱动电机8的转动轴的外侧、旋转主轴5的外侧和角度检测编码器6下侧所固定的传动轴的外侧;旋转主轴5位于基座9的中心,角度检测编码器6用于采集旋转主轴5的转速;
驱动电机8通过齿轮传动组7带动旋转主轴5和角度检测编码器6旋转;旋转主轴5的顶端套接在传动轴承3的轴套内,所述传动轴承3位于基座9的顶端,传动轴承3带动3D激光雷达1和2D激光雷达2同时旋转,所述2D激光雷达2位于3D激光雷达1的下侧;2D激光雷达2用于扫描自身安装平面内的环境信息,3D激光雷达1扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;
板卡4设置在基座9内,所述板卡4用于安装板卡电源电路41、2D激光雷达数据处理器42、电极驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45;
板卡电源电路41用于为2D激光雷达数据处理器42、电极驱动控制器43、编码器数据处理器44和3D激光雷达数据处理器45供电;
2D激光雷达数据处理器42的环境信号输入端连接2D激光雷达2的扫描信号输出端,
电机驱动控制器(43)的控制信号输出端驱动电机8的控制信号输入端,
编码器数据处理器44的角度信号输入端连接角度检测编码器6角度信号输出端;
3D激光雷达1的扫描信号输出端连接3D激光雷达数据处理器45的环境数据信号输入端。
本实施方式所述的***通过使用2D、3D组合式激光雷达实现环境模型数据提取以及机器人的空间定位及导航。同步激光雷达扫描***包括一个3D空间激光扫描***、一个2D平面激光扫描***。3D空间激光扫描***与2D平面激光扫描***为同轴同步结构与旋转主轴连接,旋转主轴通过齿轮传动组与驱动电机连接。驱动电机的控制数据以及速度、转角反馈数据、3D、2D激光雷达扫描数据均交给数据处理***进行控制及数据整合输出。整个***的供电均由供电***进行分配。3D激光雷达采用一种成本低可靠性好精度略低的方案实现,2D激光雷达采用一种精度高能突出定位好的方案实现。3D、2D激光雷达同步扫描时能够同时获取空间环境数据及准确定位,给机器人提供一个相对全面的环境数据,指导机器人进行相应的运动控制,并且结构简单,可靠性高,具有较高的性价比。
本发明的目的是利用高性能的2D激光雷达进行精确定位,同时利用低成本易于实现的3D激光雷达进行空间扫描用以达到环境感知构建空间地图模型的目的,使用较低的成本即可达到服务机器人定位导航精度并不十分严苛的要求。
具体实施方式二、本实施方式是对具体实施方式一所述的应用于服务机器人的同步式地图构建与定位***的进一步说明,套设在驱动电机8的转动轴的外侧的齿轮与角度检测编码器6下侧所固定的传动轴的外侧的齿轮比例为1:1。
具体实施方式三、本实施方式是对具体实施方式一或二所述的应用于服务机器人的同步式地图构建与定位***的进一步说明,3D激光雷达1包括表面透镜、线性激光发射器、CMOS感光原件和偏光镜;
表面透镜嵌固在基座9顶端的圆台形结构上,线性激光发射器、CMOS感光原件和偏光镜均设置在基座9的圆台形结构内;
线性激光发射器的激光信号经表面透镜发射至3D激光雷达1所旋转的环境中,线性激光发射器的激光信号遇到障碍物后的反射光再次经表面透镜入射至偏光镜,所述反射光经偏光镜后入射至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°方向的所有数据均计算完成后,即可得出周围环境的所有距离数据。将数据汇总,便是周围环境信息。
本发明所述***该***包括基座及激光扫描***,激光扫描***中包括3D激光雷达和2D激光雷达,两种雷达分层排布,2D激光雷达在底层扫描整个环境的低层平面,其反馈的数据用于定位和导航使用。3D激光雷达在上方扫描的一定范围的空间环境,其反馈数据用于构建整个环境地图,两种雷达契合在一个扫描主体即激光扫描***上,该结构用来达到同步效果,当激光扫描***工作旋转时,3D激光雷达及2D激光雷达均旋转,旋转速度完全一致,其旋转频率要求调控范围在5-10Hz范围内。3D激光雷达与2D激光雷达之间互成一定的角度,防止互相干扰。整个激光扫描雷达与基座的输出轴即旋转主轴连接,由主轴带动这个激光扫描***进行旋转,主轴通过齿轮传动组与驱动电机及角度检测编码器连接,齿轮传动组中连接旋转主轴及编码器的齿轮比例为1:1,旋转主轴与驱动电机的齿轮传动比例则根据电机性能匹配,匹配标准为输出旋转主轴的转动分辨率=<1°,驱动电机的选用标准为转动平稳,不同速度要求下均有稳定的转速表现。
具体实施方式四、本实施方式所述的应用于服务机器人的异步式地图构建与定位方法,该方法的具体步骤为:
步骤一、采用驱动电机8通过齿轮传动组7带动旋转主轴5和角度检测编码器6旋转;将2D激光雷达2和3D激光雷达1通过传动轴承3安装在旋转主轴5的顶端;
步骤二、角度检测编码器6对2D激光雷达2和3D激光雷达1的所连接的旋转主轴5的转速进行检测;并将检测信息发送至编码器数据处理器44;
步骤三、采用2D激光雷达2扫描自身所在平面环境信息,采用3D激光雷达1扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;2D激光雷达2扫描自身安装平面内的环境信息,且2D激光雷达2的扫描区域与3D激光雷达1的扫描区域互不重叠;
步骤四、对编码器数据处理器44接收到的2D激光雷达2和3D激光雷达1的转速信息与2D激光雷达2扫描机器人周围环境的障碍物信息和3D激光雷达1扫描自身安装水平面向上夹角为0°~45°范围内的环境信息进行数据组合;
步骤五、采用基于特征提取的SLAM算法实现对3D激光雷达1扫描的环境信息与2D激光雷达2扫描的环境信息进行对应处理,实现对服务机器人周围环境地图的构建与定位。
当设备工作时,整个激光扫描***开始根据设定转速转动输出,3D激光雷达与2D激光雷达均开始数据输出,3D激光雷达单次扫描为一个空间纵向截面数据,旋转360°后则获得了设备周围整个空间的纵向截面数据,通过算法对获得数据融合获得周围空间环境数据,从而构建出整个周围空间的地图数据,2D激光雷达单次扫描为设备所在环境的一个横向截面的一个点位数据,旋转360°后则获得所在横向截面的所有数据,通过算法进行数据融合后,获得所在环境2D激光雷达所在环境的位置。从而实现机器人的地图构建及定位。
实施例:
驱动电机选用直流伺服电机额定转速为1200n/min,传动齿轮组中驱动电机与旋转主轴的传动速比为1:2,角度检测编码器选用单圈绝对值编码器,2D激光雷达采用TOF测距法激光雷达,3D激光雷达采用线性激光发射器与COMS感光元件组、偏光镜组成的三角测距法激光雷达。设备上电后,对基座内部板卡进行供电,给与控制5Hz转速的控制指令,数据处理***将5Hz的控制指令转换成50%占空比的PWM驱动电机控制性号,控制电机以600n/min的转速即10hz转动频率稳定转动,通过1:2的齿轮传动组,控制旋转主轴以5Hz转动,旋转主轴带动2D、3D激光雷达以5Hz的转动频率转动,2D、3D激光雷达开始获取周围环境的测距信息,分别通过各自的数据采集板进行数据纠偏处理,将处理后的数据传输给基座内部的数据处理***,数据处理***将3D激光雷达获取到的单个位置的纵向截面数据结合绝对值编码器给出的角度信息组合成一组数据,该组数据为本***在该位置该方向的环境信息,连续旋转一周得到的每一组数据均做数据组合,所得到的数据组为本***所在环境的环境距离信息,在经过算法融合构建出设备周围的环境地图信息。同时数据处理***将高精度2D激光雷达获取到的单个位置的数据结合绝对值编码器给出的角度信息组合成一组数据,该组数据为本***在该位置该方向2D激光雷达高度的横向截面中的测距数据,连续旋转一周后获得的所有数据均做此处理,所得到的数据组为本***所在环境的2D激光雷达高度的横向截面距离信息,经过SLAM算法等数学模型的换算融合的到本***所在环境的位置信息。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,一体地连接,也可以是可拆卸连接;可以是两个元件内部的连通;可以是直接相连,也可以通过中间媒介间接相连,对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.应用于服务机器人的同步式地图构建与定位***,其特征在于,它包括3D激光雷达(1)、2D激光雷达(2)、传动轴承(3)、板卡(4)、旋转主轴(5)、角度检测编码器(6)、齿轮传动组(7)、驱动电机(8)和基座(9);
基座(9)下部为中空结构的柱体,上部为中空结构的圆台形,所述圆台形为上下均开口结构;
齿轮传动组(7)包括三个齿轮,所述三个齿轮均设置在基座(9)的底部,且三个齿轮依次咬合,三个齿轮分别套设在驱动电机(8)的转动轴的外侧、旋转主轴(5)的外侧和角度检测编码器(6)下侧所固定的传动轴的外侧;旋转主轴(5)位于基座(9)的中心,角度检测编码器(6)用于采集旋转主轴(5)的转速;
驱动电机(8)通过齿轮传动组(7)带动旋转主轴(5)和角度检测编码器(6)旋转;旋转主轴(5)的顶端套接在传动轴承(3)的轴套内,所述传动轴承(3)位于基座(9)的顶端,传动轴承(3)带动3D激光雷达(1)和2D激光雷达(2)同时旋转,所述2D激光雷达(2)位于3D激光雷达(1)的下侧;2D激光雷达(2)用于扫描自身安装平面内的环境信息,3D激光雷达(1)扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;
板卡(4)设置在基座(9)内,所述板卡(4)用于安装板卡电源电路(41)、2D激光雷达数据处理器(42)、电极驱动控制器(43)、编码器数据处理器(44)和3D激光雷达数据处理器(45);
板卡电源电路(41)用于为2D激光雷达数据处理器(42)、电极驱动控制器(43)、编码器数据处理器(44)和3D激光雷达数据处理器(45)供电;
2D激光雷达数据处理器(42)的环境信号输入端连接2D激光雷达(2)的扫描信号输出端,
电机驱动控制器(43)的控制信号输出端驱动电机(8)的控制信号输入端,
编码器数据处理器(44)的角度信号输入端连接角度检测编码器(6)角度信号输出端;
3D激光雷达(1)的扫描信号输出端连接3D激光雷达数据处理器(45)的环境数据信号输入端。
2.根据权利要求1所述的应用于服务机器人的同步式地图构建与定位***,其特征在于,套设在驱动电机(8)的转动轴的外侧的齿轮与角度检测编码器(6)下侧所固定的传动轴的外侧的齿轮比例为1:1。
3.根据权利要求1或2所述的应用于服务机器人的同步式地图构建与定位***,其特征在于,3D激光雷达(1)包括表面透镜、线性激光发射器、CMOS感光原件和偏光镜;
表面透镜嵌固在基座(9)顶端的圆台形结构上,线性激光发射器、CMOS感光原件和偏光镜均设置在基座(9)的圆台形结构内;
线性激光发射器的激光信号经表面透镜发射至3D激光雷达(1)所旋转的环境中,线性激光发射器的激光信号遇到障碍物后的反射光再次经表面透镜入射至偏光镜,所述反射光经偏光镜后入射至CMOS感光原件的感光面上,所述CMOS感光原件的信号输出端连接3D激光雷达数据处理器(45)的的环境数据信号输入端。
4.应用于服务机器人的异步式地图构建与定位方法,其特征在于,该方法的具体步骤为:
步骤一、采用驱动电机(8)通过齿轮传动组(7)带动旋转主轴(5)和角度检测编码器(6)旋转;将2D激光雷达(2)和3D激光雷达(1)通过传动轴承(3)安装在旋转主轴(5)的顶端;
步骤二、角度检测编码器(6)对2D激光雷达(2)和3D激光雷达(1)的所连接的旋转主轴(5)的转速进行检测;并将检测信息发送至编码器数据处理器(44);
步骤三、采用2D激光雷达(2)扫描自身所在平面环境信息,采用3D激光雷达(1)扫描自身安装水平面向上夹角为0°~45°范围内的环境信息;2D激光雷达(2)扫描自身安装平面内的环境信息,且2D激光雷达(2)的扫描区域与3D激光雷达(1)的扫描区域互不重叠;
步骤四、对编码器数据处理器(44)接收到的2D激光雷达(2)和3D激光雷达(1)的转速信息与2D激光雷达(2)扫描机器人周围环境的障碍物信息和3D激光雷达(1)扫描自身安装水平面向上夹角为0°~45°范围内的环境信息进行数据组合;
步骤五、采用基于特征提取的SLAM算法实现对3D激光雷达(1)扫描的环境信息与2D激光雷达(2)扫描的环境信息进行对应处理,实现对服务机器人周围环境地图的构建与定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710186978.5A CN106886030B (zh) | 2017-03-24 | 2017-03-24 | 应用于服务机器人的同步式地图构建与定位***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710186978.5A CN106886030B (zh) | 2017-03-24 | 2017-03-24 | 应用于服务机器人的同步式地图构建与定位***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106886030A true CN106886030A (zh) | 2017-06-23 |
CN106886030B CN106886030B (zh) | 2019-05-07 |
Family
ID=59181399
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710186978.5A Active CN106886030B (zh) | 2017-03-24 | 2017-03-24 | 应用于服务机器人的同步式地图构建与定位***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106886030B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108196550A (zh) * | 2018-02-08 | 2018-06-22 | 广东工业大学 | 一种自动导向小车及其自动控制方法 |
CN108362288A (zh) * | 2018-02-08 | 2018-08-03 | 北方工业大学 | 一种基于无迹卡尔曼滤波的偏振光slam方法 |
CN108387236A (zh) * | 2018-02-08 | 2018-08-10 | 北方工业大学 | 一种基于扩展卡尔曼滤波的偏振光slam方法 |
CN108762255A (zh) * | 2018-05-03 | 2018-11-06 | 南京理工大学 | 一种室内智能移动机器人及控制方法 |
WO2019165603A1 (zh) * | 2018-02-28 | 2019-09-06 | 深圳市欢创科技有限公司 | 一种三维空间测量的方法、装置及*** |
CN110244702A (zh) * | 2018-03-07 | 2019-09-17 | 罗伯特·博世有限公司 | 用于生成或更新周围环境地图的方法和定位*** |
CN110398751A (zh) * | 2019-09-11 | 2019-11-01 | 北京云迹科技有限公司 | 基于激光雷达生成地图的***及方法 |
CN111007528A (zh) * | 2019-12-17 | 2020-04-14 | 深圳市优必选科技股份有限公司 | 巡检机器人 |
CN111044982A (zh) * | 2019-12-23 | 2020-04-21 | 珠海纳睿达科技有限公司 | 一种雷达方位定位的方法 |
CN115494478A (zh) * | 2022-11-15 | 2022-12-20 | 杭州欧镭激光技术有限公司 | 一种激光雷达 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101008571A (zh) * | 2007-01-29 | 2007-08-01 | 中南大学 | 一种移动机器人三维环境感知方法 |
JP5035214B2 (ja) * | 2008-10-28 | 2012-09-26 | 株式会社日本自動車部品総合研究所 | 光走査装置 |
CN103837095A (zh) * | 2014-03-18 | 2014-06-04 | 华中科技大学 | 一种三维激光扫描方法及装置 |
CN105068085A (zh) * | 2015-07-27 | 2015-11-18 | 中国科学技术大学 | 高精度单电机传动激光雷达三维扫描仪 |
CN105676209A (zh) * | 2016-04-01 | 2016-06-15 | 山东理工大学 | 一种直升机载激光雷达平台三维姿态角复杂振动实时补偿方法与装置 |
-
2017
- 2017-03-24 CN CN201710186978.5A patent/CN106886030B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101008571A (zh) * | 2007-01-29 | 2007-08-01 | 中南大学 | 一种移动机器人三维环境感知方法 |
JP5035214B2 (ja) * | 2008-10-28 | 2012-09-26 | 株式会社日本自動車部品総合研究所 | 光走査装置 |
CN103837095A (zh) * | 2014-03-18 | 2014-06-04 | 华中科技大学 | 一种三维激光扫描方法及装置 |
CN105068085A (zh) * | 2015-07-27 | 2015-11-18 | 中国科学技术大学 | 高精度单电机传动激光雷达三维扫描仪 |
CN105676209A (zh) * | 2016-04-01 | 2016-06-15 | 山东理工大学 | 一种直升机载激光雷达平台三维姿态角复杂振动实时补偿方法与装置 |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108362288B (zh) * | 2018-02-08 | 2021-05-07 | 北方工业大学 | 一种基于无迹卡尔曼滤波的偏振光slam方法 |
CN108362288A (zh) * | 2018-02-08 | 2018-08-03 | 北方工业大学 | 一种基于无迹卡尔曼滤波的偏振光slam方法 |
CN108387236A (zh) * | 2018-02-08 | 2018-08-10 | 北方工业大学 | 一种基于扩展卡尔曼滤波的偏振光slam方法 |
CN108196550A (zh) * | 2018-02-08 | 2018-06-22 | 广东工业大学 | 一种自动导向小车及其自动控制方法 |
CN108387236B (zh) * | 2018-02-08 | 2021-05-07 | 北方工业大学 | 一种基于扩展卡尔曼滤波的偏振光slam方法 |
WO2019165603A1 (zh) * | 2018-02-28 | 2019-09-06 | 深圳市欢创科技有限公司 | 一种三维空间测量的方法、装置及*** |
CN110244702A (zh) * | 2018-03-07 | 2019-09-17 | 罗伯特·博世有限公司 | 用于生成或更新周围环境地图的方法和定位*** |
CN108762255A (zh) * | 2018-05-03 | 2018-11-06 | 南京理工大学 | 一种室内智能移动机器人及控制方法 |
CN110398751A (zh) * | 2019-09-11 | 2019-11-01 | 北京云迹科技有限公司 | 基于激光雷达生成地图的***及方法 |
CN111007528A (zh) * | 2019-12-17 | 2020-04-14 | 深圳市优必选科技股份有限公司 | 巡检机器人 |
CN111044982A (zh) * | 2019-12-23 | 2020-04-21 | 珠海纳睿达科技有限公司 | 一种雷达方位定位的方法 |
CN111044982B (zh) * | 2019-12-23 | 2021-09-28 | 广东纳睿雷达科技股份有限公司 | 一种雷达方位定位的方法 |
CN115494478A (zh) * | 2022-11-15 | 2022-12-20 | 杭州欧镭激光技术有限公司 | 一种激光雷达 |
Also Published As
Publication number | Publication date |
---|---|
CN106886030B (zh) | 2019-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106886030A (zh) | 应用于服务机器人的同步式地图构建与定位***及方法 | |
CN107044857A (zh) | 应用于服务机器人的异步式地图构建与定位***及方法 | |
CN101629806B (zh) | 结合激光发射器的非线性ccd三维定位装置及定位方法 | |
US11402506B2 (en) | Laser measuring method and laser measuring instrument | |
US10983196B2 (en) | Laser scanner and surveying system | |
US20190079522A1 (en) | Unmanned aerial vehicle having a projector and being tracked by a laser tracker | |
CN108398696A (zh) | 多线旋转式激光雷达装置 | |
US20160131479A1 (en) | Tilt Detecting System And Tilt Detecting Method | |
WO2019085376A1 (zh) | 激光扫描装置及其控制方法、移动测量***及其控制方法 | |
CN104132639A (zh) | 一种微型光学扫描测距装置及方法 | |
WO2014068406A2 (en) | Device for optically scanning and measuring an environment | |
CN106556826B (zh) | 变电站巡检机器人定位导航用二维激光雷达标定装置及方法 | |
CN106197385A (zh) | 测量装置 | |
CN101852607A (zh) | 旋转式激光视觉线阵空间识别定位*** | |
CN207965645U (zh) | 一种机器人自主导航*** | |
CN110966921B (zh) | 室内三维扫描设备及方法 | |
CN106969724B (zh) | 一种自旋转十字线激光扫描的环境三维形貌感知装置 | |
CN105698749A (zh) | 一种激光测距传感器 | |
CN204240979U (zh) | 微型光学扫描测距装置、***及光学测距*** | |
CN107063123B (zh) | 360度环境形貌自旋转激光扫描方法 | |
CN111948667A (zh) | 三维扫描*** | |
CN106289104B (zh) | 彩色三维激光扫描仪 | |
CN214951112U (zh) | 一种基于激光测距与视觉辅助识别的测量设备 | |
CN208421236U (zh) | 一种测距装置 | |
CN201876259U (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 | ||
CP03 | Change of name, title or address | ||
CP03 | Change of name, title or address |
Address after: 210000 room 6117, floor 1, building 6, Nanjing Jima Industrial Park, No. 669, Jiangjun Avenue, moling street, Jiangning District, Nanjing, Jiangsu Province (Jiangning Development Zone) Patentee after: Nanjing Sizhi robot Co.,Ltd. Address before: 150000 room 701, Hongyang building, No. 380, Changjiang Road, Nangang concentration area, economic development zone, Harbin, Heilongjiang Province Patentee before: HEILONGJIANG GUIZHI THE ROBOT Co.,Ltd. |