基于多线激光的扫描式障碍物检测方法技术

本发明专利技术涉及一种基于多线激光的扫描式障碍物检测方法，其特征是：采用激光点云外参自动标定方式，对激光点云进行排序和收集，通过扫描式检测，对点云进行离散化和栅格化，满足在非水平路面行驶环境下的多线激光雷达扫描式障碍物检测。有益效果：本发明专利技术能够克服由于车辆行驶在非水平路面产生的颠簸以及车身与车架之间非刚性连接等因素导致检测结果不精确，提高了障碍物检测鲁棒性和精度。

【技术实现步骤摘要】
基于多线激光的扫描式障碍物检测方法
本专利技术属于智能驾驶
，尤其涉及一种基于多线激光的扫描式障碍物检测方法。
技术介绍
随着自动化技术与无人驾驶技术发展，对环境感知技术要求越来越高。目前，由于摄像头图像检测技术在晚上、曝光过强、雨雪雾等恶劣情况下无法工作，而毫米波雷达由于其信息量少且其只对金属等物体反射敏感因而也不适用于智能驾驶环境感知中。多线激光雷达具有测距准且对环境要求低的优点，越来越多地被应用在智能驾驶环境感知中。如图6所示，一般基于激光雷达障碍物检测技术其检测步骤如下，首先，将激光雷达扫描到的点云无序的放置在一起；其次，对这些点云进行平面拟合，从而滤出路面，最后，将残存的点云进行离散化和栅格化，形成最终的障碍物检测结果。当前传统的多线激光雷达基于障碍物检测技术存在以下问题：一、单纯的平面拟合无法解决有坡度路面问题；二、车辆在行驶过程中，由于车架和车身的非刚性连接以及地面颠簸等问题，多线激光每根线束的外参都是动态变化的，从而使得默认标定统一的外参无法真实的描述每个点云点的真实位置；三、由于多线激光的点云是由内到外非均匀分布，因此单纯进行简单的栅格和离散化并不能很好的利用点云信息。
技术实现思路
本专利技术的目的在于克服上述技术的不足，而提供一种基于多线激光的扫描式障碍物检测方法，可以在障碍物检测过程中，克服由于车辆行驶在非水平路面过程中颠簸以及车身与车架之间非刚性连接等因素而影响检测结果，提高了障碍物检测的鲁棒性和精度。本专利技术为实现上述目的，采用以下技术方案：一种基于多线激光的扫描式障碍物检测方法，其特征是：采用激光点云外参自动标定方式，对激光点云进行排序和收集，通过扫描式检测，对点云进行离散化和栅格化，满足在非水平路面行驶环境下的多线激光雷达扫描式障碍物检测，具体步骤如下：步骤一、外参姿态动态自动标定1)外参粗估计：采集一段车辆匀速行驶的点云簇，通过手工测量大致估算航向角、俯仰角、横摆角；2)利用高度约束筛选点云：选取符合高度约束的点云数据，高度Z选择在[Zmin，Zmax]范围内的所有点云；3)路面拟合：利用Ransac算法拟合路面，确定路面基准方程及满足基准方程要求的内点点云；将内点点云以及基准方程投影到xy平面上，精确估计航向角；将内点点云以及基准方程投影到xz平面上，精确估计俯仰角；将内点点云以及基准方程投影到yz平面上，精确估计横摆角；步骤二、点云排序和收集对步骤一采集到的点云簇进行极坐标转换；对点云进行排序和收集，构建极坐标下的点云矩阵进行存储，对全部激光点云按照航向角和俯仰角的角度进行存储；步骤三、扫描式检测对点云矩阵中每个元素进行搜索，检测出其中的障碍物；步骤四、离散化和栅格化根据指定的横向分辨率和纵向分辨率创建栅格地图，将障碍物对应的点云点离散化到每个栅格结果中；步骤五，利用四元数方法输出多线点云的姿态结果完成外参的自动标定。所述步骤一中所述路面拟合的具体方法为：选取的路面点云利用Ransac算法拟合路面，确定路面的基准方程：a)随机选取三个点云估计路面的基准方程ax+by+cz+d＝0；b)内点定义为待选路面点，即在步骤a)中估计的基准方程上的点，将待选的路面点云进行内点统计，保留内点数目和基准方程；c)重复步骤a)、b)直到超过迭代次数时退出，期间保留内点数据数目最多的基准方程即为路面的基准方程；d)输出路面的基准方程。所述步骤一中内点点云以及基准方程分别投影到xy、xz、yz平面上，精确估计航向角、俯仰角和横摆角的方法为：a)分别忽略z，y和x坐标，将内点点云投影到三个平面上；b)通过自动识别护栏、路沿、墙面或者建筑物，进行直线拟合；c)将直线转化为斜率角度，作为航向角、俯仰角、横摆角的精确化估计结果。有益效果：本专利技术能够克服由于车辆行驶在非水平路面产生的颠簸以及车身与车架之间非刚性连接等因素导致检测结果不精确，提高了障碍物检测鲁棒性和精度。附图说明图1是本专利技术障碍物检测方法的框架图；图2是激光线束外参确定流程图；图3是激光雷达安装结构示意图；图4是栅格地图离散化前的结果示意图；图5是栅格地图离散化后的结果示意图；图6是传统基于多线激光雷达障碍物检测方法的框架图。图中：A、路面点，B、检测到的障碍物。具体实施方式下面结合较佳实施例详细说明本专利技术的具体实施方式。详见附图1、2，为解决提到的车辆行驶过程中由于车架和车身的非刚性连接以及地面颠簸等问题导致多线激光线束外参动态变化，使用默认外参估计值而不准确问题，本实施例提供一种基于多线激光的扫描式障碍物检测方法，采用激光点云外参自动标定方式，对激光点云进行排序和收集，通过扫描式检测，对点云进行离散化和栅格化，满足在非水平路面行驶环境下的多线激光雷达扫描式障碍物检测，具体步骤如下：步骤一、外参姿态动态自动标定1、利用安装在车顶的多线激光雷达采集一段车辆匀速行驶的点云簇，值得提的是本实施例中使用的多线激光雷达为：Velodyne16线激光雷达，其垂直扫描角度为30°，垂直分辨率为2°，水平扫描角度为360°，水平分辨率率为0.2°，转速为10HZ。具体安装方法如图3所示，x轴平行于车辆前进方向，y轴垂直于车辆前进方向向左，z轴垂直于车辆所在地平面向上，坐标原点为车辆后轴中心点落在地平面的交点。将Velodyne16线激光雷达安装于车顶，底部通过螺丝固定，一端连接12V电源，另一端连接网线进行数据输出。通过该多线激光雷达采集到的点云簇为由x，y，z三个坐标组成的点集；另外值得提的是，驾驶路段必须保证道路两侧有护栏，路沿，墙面或者建筑物作为障碍物，对采集到的点云簇通过手动测量，大致估算出多线激光雷达相对于路面的姿态，包括航向、俯仰、横摆三个角度，采集到的三个参数作为标定的默认参数，参考此默认参数可以将激光点云扫描结果投影到真实世界坐标系中；2、采集到的点云簇，通过简单的高度约束选出一些待选的路面点云，比如选择高度Z在[Zmin，Zmax]范围内的所有点云；对于高度Z的选取方法如下，由于激光雷达的安装位置是固定的，所以通常认为Z＝0的地方为路面，Zmin与Zmax取值不会离0很远，本实施例中选取Zmin＝-0.3m，Zmax＝0.3m；3、选取的路面点云利用Ransac算法拟合路面，确定路面的基准方程。具体实施方法如下：a)随机选取三个点云估计路面的基准方程ax+by+cz+d＝0；b)对待选的路面点云进行内点统计，内点定义为待选路面点在步骤a)中估计的基准方程上的点，保留内点数目和基准方程；c)重复步骤a)、b)；d)直到超过迭代次数时退出，期间保留内点数据数目最多的基准方程即为路面的基准方程；e)输出路面的基准方程；步骤四，将步骤三中路面的基准方程和路面内点点云分别投影到xy、xz、yz平面，精确化前述步骤中手动测量的航向、俯仰、横摆三个角度。具体实施方法如下：a)分别忽略z，y和x坐标，将点云投影到三个平面上；b)通过自动识别护栏、路沿、墙面或者建筑物，进行直线拟合；c)将直线转化为斜率角度，作为航向、俯仰、横摆三个角度的精确化估计结果；步骤五，利用四元数方法输出多线点云的姿态结果完成外参的自动标定。具体的将航向角、俯仰角、横摆角(绕固定坐标系X-Y-Z依次旋转的角度)转换为四元数公式如下，为了便于描述，将航向角定义为α本文档来自技高网...

【技术保护点】
1.一种基于多线激光的扫描式障碍物检测方法，其特征是：采用激光点云外参自动标定方式，对激光点云进行排序和收集，通过扫描式检测，对点云进行离散化和栅格化，满足在非水平路面行驶环境下的多线激光雷达扫描式障碍物检测，具体步骤如下：步骤一、外参姿态动态自动标定1)外参粗估计：采集一段车辆匀速行驶的点云簇，通过手工测量大致估算航向角、俯仰角、横摆角；2)利用高度筛选点云：选取符合高度约束的点云数据，选择高度Z在[Zmin，Zmax]范围内的所有点云；3)路面拟合：利用Ransac算法拟合路面，确定路面基准方程及满足基准方程要求的内点点云；将内点点云以及基准方程投影到xy平面上，精确估计航向角；将内点点云以及基准方程投影到xz平面上，精确估计俯仰角；将内点点云以及基准方程投影到yz平面上，精确估计横摆角；步骤二、点云排序和收集对步骤一采集到的点云簇进行极坐标转换；对点云进行排序和收集，构建极坐标下的点云矩阵进行存储，对全部激光点云按照航向角和俯仰角的角度进行存储；步骤三、扫描式检测对点云矩阵中每个元素进行搜索，检测出其中的障碍物；步骤四、离散化和栅格化根据指定的横向分辨率和纵向分辨率创建栅格地图，将障碍物对应的点云点离散化到每个栅格结果中；步骤五，利用四元数方法输出多线点云的姿态结果完成外参的自动标定。...

【技术特征摘要】
1.一种基于多线激光的扫描式障碍物检测方法，其特征是：采用激光点云外参自动标定方式，对激光点云进行排序和收集，通过扫描式检测，对点云进行离散化和栅格化，满足在非水平路面行驶环境下的多线激光雷达扫描式障碍物检测，具体步骤如下：步骤一、外参姿态动态自动标定1)外参粗估计：采集一段车辆匀速行驶的点云簇，通过手工测量大致估算航向角、俯仰角、横摆角；2)利用高度筛选点云：选取符合高度约束的点云数据，选择高度Z在[Zmin，Zmax]范围内的所有点云；3)路面拟合：利用Ransac算法拟合路面，确定路面基准方程及满足基准方程要求的内点点云；将内点点云以及基准方程投影到xy平面上，精确估计航向角；将内点点云以及基准方程投影到xz平面上，精确估计俯仰角；将内点点云以及基准方程投影到yz平面上，精确估计横摆角；步骤二、点云排序和收集对步骤一采集到的点云簇进行极坐标转换；对点云进行排序和收集，构建极坐标下的点云矩阵进行存储，对全部激光点云按照航向角和俯仰角的角度进行存储；步骤三、扫描式检测对点云矩阵中每个元素进行搜索，检测出其中的障碍物；步骤四、离散化和栅格化根据指定的横向分...

【专利技术属性】
技术研发人员：何贝，张天雷，郑思仪，刘鹤云，
申请(专利权)人：北京主线科技有限公司，
类型：发明
国别省市：北京,11