基于激光雷达传感器的障碍物距离反馈方法及装置制造方法及图纸

本发明专利技术公开了一种基于激光雷达传感器的障碍物距离反馈方法，包括以下步骤：构建AGV小车的车体坐标系；构建激光雷达传感器的坐标系；驱动激光雷达传感器扫描障碍物，并获取障碍物在激光雷达传感器的坐标系中的位置坐标；以及，将激光雷达传感器的坐标系和车体坐标系进行变换，以获取障碍物在车体坐标系中的位置坐标；以及，基于障碍物在车体坐标系中的位置坐标，获取障碍物到AGV小车的车体中心的距离。获取障碍物到AGV小车的车体中心的距离。获取障碍物到AGV小车的车体中心的距离。

【技术实现步骤摘要】
基于激光雷达传感器的障碍物距离反馈方法及装置


[0001]本专利技术涉及激光雷达传感器应用
，尤其是涉及一种基于激光雷达传感器的障碍物距离反馈方法及装置。

技术介绍

[0002]激光雷达传感器是根据飞行时间(TOF)测量原理运行的。在极高的同步时钟下，以均匀的时间间隔发射激光，激光光束遇到物体时会反射回来，扫描传感器接收到反射的光束后，通过发射和接收的时间差Δt来计算从激光传感器到物体的距离。
[0003]现有技术中，通常利用激光光束对周围进行二维扫描，获得一个环境轮廓图形；通过2D激光反馈的X、Y数据及ICP计算出来的对应的角度来实现对障碍物的大小尺寸、偏差Δx、Δy、Δθ来判断是否可以绕行、纠偏、尺寸大小等功能。
[0004]然而，激光雷达避障区域有限，且不能实时反馈障碍物的距离，机器人无法根据雷达扫描测量障碍物距离的数据，实现准确避障，物体特征识别及辅助二次辅助定位导航。

技术实现思路

[0005]本专利技术旨在至少解决上述技术问题之一。
[0006]为此，本专利技术提出了一种基于激光雷达传感器的障碍物距离反馈方法及装置，以解决激光雷达避障区域有限、识别区域少以及不能实时反馈障碍物距离作为判断依据的问题。
[0007]根据本申请的第一方面实施例，提供了一种基于激光雷达传感器的障碍物距离反馈方法，包括以下步骤：
[0008]构建AGV小车的车体坐标系；
[0009]构建激光雷达传感器的坐标系；
[0010]驱动所述激光雷达传感器扫描障碍物，并获取所述障碍物在所述激光雷达传感器的坐标系中的位置坐标；以及，将所述激光雷达传感器的坐标系和所述车体坐标系进行变换，以获取所述障碍物在所述车体坐标系中的位置坐标；以及，基于所述障碍物在所述车体坐标系中的位置坐标，获取所述障碍物到所述AGV小车的车体中心的距离。
[0011]在上述方法中，所述激光雷达传感器的坐标系与所述车体坐标系间的变换关系式如下：
[0012][0013]式中：X、Y、Z为车体坐标系；x、y、z为激光雷达传感器的坐标系；α为翻滚角；β为俯仰角；θ为偏航角。
[0014]在上述方法中，所述激光雷达传感器的坐标系与所述车体坐标系间的变换通过ROS系统中的坐标变换模块TF2实现。
[0015]在上述方法中，所述障碍物的轮廓线与所述AGV小车的行进方向的夹角在
‑
15
°
～+15
°
之间。
[0016]在上述方法中，所述障碍物的轮廓线长度大于等于0.7m。
[0017]在上述方法中，所述激光雷达传感器水平安装在所述AGV小车的插脚上。
[0018]根据本申请的第二方面实施例，提供了一种基于激光雷达传感器的障碍物距离反馈装置，包括：
[0019]车体坐标系构建模块，用于构建AGV小车的车体坐标系；
[0020]传感器坐标系构建模块，用于构建激光雷达传感器的坐标系；
[0021]距离获取模块，用于驱动所述激光雷达传感器扫描障碍物，并获取所述障碍物在所述激光雷达传感器的坐标系中的位置坐标；以及，用于将所述激光雷达传感器的坐标系和所述车体坐标系进行变换，以获取所述障碍物在所述车体坐标系中的位置坐标；以及，用于基于所述障碍物在所述车体坐标系中的位置坐标，获取所述障碍物到所述AGV小车的车体中心的距离。
[0022]在上述装置中，所述距离获取模块包括：
[0023]第一位置坐标获取单元，用于驱动所述激光雷达传感器扫描障碍物，并获取所述障碍物在所述激光雷达传感器的坐标系中的位置坐标；
[0024]第二位置坐标获取单元，用于将所述激光雷达传感器的坐标系和所述车体坐标系进行变换，以获取所述障碍物在所述车体坐标系中的位置坐标；
[0025]距离获取单元，用于基于所述障碍物在所述车体坐标系中的位置坐标，计算获取所述障碍物到所述AGV小车的车体中心的距离。
[0026]根据本申请的第三方面实施例，提供了一种终端，包括存储器和处理器，所述存储器上存储有可在所述处理器上运行的计算机程序，所述处理器运行所述计算机程序时执行上述所述的基于激光雷达传感器的障碍物距离反馈方法。
[0027]根据本申请的第四方面实施例，提供了一种计算机可读存储介质，所述计算机可读存储介质包括存储的计算机程序，其中，在所述计算机程序被处理器运行时控制所述存储介质所在终端执行上述所述的基于激光雷达传感器的障碍物距离反馈方法。
[0028]根据本申请所提供的技术方案，至少具有如下有益效果，通过激光雷达传感器扫描障碍物，即可实时获取障碍物在激光雷达传感器的坐标系中的位置坐标，也即是障碍物相对激光雷达传感器的位置和距离；通过将激光雷达传感器的坐标系与车体坐标系进行变换，即可实时获取障碍物在车体坐标系中的位置坐标，也即是实时获取障碍物相对AGV小车的位置和距离，有利于AGV小车在行进过程中能够准确避障。采用上述反馈方法和反馈装置，在使激光雷达传感器摆脱激光避障区域限制的同时，还可以识别障碍物相对激光雷达传感器的坐标系的X轴、Y轴的偏差距离及偏差角度，以便提供精确的导航定位。
[0029]本申请的其它特征和优点将在随后的说明书中阐述，并且，部分地从说明书中变得显而易见，或者通过实施本申请而了解。本申请的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
附图说明
[0030]本专利技术的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得
明显和容易理解，其中：
[0031]图1为本专利技术实施例提供的AGV小车的结构示意图；
[0032]图2为本专利技术实施例提供的反馈方法的流程图；
[0033]图3为本专利技术实施例提供的翻滚角、俯仰角和偏航角的示意图；
[0034]图4为本专利技术实施例提供的一个应用场景图；
[0035]图5为本专利技术实施例提供的一个识别场景图；
[0036]图6为本专利技术实施例提供的另一个识别场景图；
[0037]图7为本专利技术实施例提供的另一个应用场景图；
[0038]图8为本专利技术实施例提供的反馈装置的结构框图。
[0039]附图标记：
[0040]车体坐标系构建模块10、传感器坐标系构建模块20、距离获取模块30、第一位置坐标获取单元31、第二位置坐标获取单元32、距离获取单元33
具体实施方式
[0041]为了使本申请的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本申请进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本申请，并不用于限定本申请。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本申请保护的范围。
[0042]需要说明的是，虽然在装置示意图中进行了功能模块划分，在流程图中示出了逻辑顺序，但是在某些情况下，可以以不同于装置中的模块划分，或流程图中的顺本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于激光雷达传感器的障碍物距离反馈方法，其特征在于，包括以下步骤：构建AGV小车的车体坐标系；构建激光雷达传感器的坐标系；驱动所述激光雷达传感器扫描障碍物，并获取所述障碍物在所述激光雷达传感器的坐标系中的位置坐标；以及，将所述激光雷达传感器的坐标系和所述车体坐标系进行变换，以获取所述障碍物在所述车体坐标系中的位置坐标；以及，基于所述障碍物在所述车体坐标系中的位置坐标，获取所述障碍物到所述AGV小车的车体中心的距离。2.根据权利要求1所述的反馈方法，其特征在于，所述激光雷达传感器的坐标系与所述车体坐标系间的变换关系式如下：式中：X、Y、Z为车体坐标系；x、y、z为激光雷达传感器的坐标系；α为翻滚角；β为俯仰角；θ为偏航角。3.根据权利要求1所述的反馈方法，其特征在于，所述激光雷达传感器的坐标系与所述车体坐标系间的变换通过ROS系统中的坐标变换模块TF2实现。4.根据权利要求1所述的反馈方法，其特征在于，所述障碍物的轮廓线与所述AGV小车的行进方向的夹角在
‑
15
°
～+15
°
之间。5.根据权利要求1所述的反演方法，其特征在于，所述障碍物的轮廓线长度大于等于0.7m。6.根据权利要求1所述的反演方法，其特征在于，所述激光雷达传感器水平安装在所述AGV小车的插脚上。7.一种基于激光雷达传感器的障碍物距离反馈装置，其特征在于，包括：车体坐标系构建模块，用于构建AGV小...

【专利技术属性】
技术研发人员：李飞军，邹家帅，昝学彦，阮伟杰，陈斯源，赵华祥，李发频，蒋干胜，徐波，
申请(专利权)人：珠海创智科技有限公司，
类型：发明
国别省市：