[发明专利]一种激光雷达地下斜坡深度探测方法和探测车辆

说明书

本发明涉及一种激光雷达地下斜坡深度探测方法和探测车辆。本发明通过控制探测车辆沿着地下斜坡行驶，记录形成的雷达探测区域在垂直方向上的最高坐标和最低坐标，通过坐标之间的差值计算获取多个深度分值，然后将全部的深度分值相加以获得所述地下斜坡的深度。本发明能够巧妙地采用探测车辆的车载激光雷达的纵坐标采集能力，简单、准确且低成本地实现了封闭环境中地下斜坡深度的探测。

技术领域

本发明涉及地下工业车辆驾驶领域，更具体地说，涉及一种激光雷达地下斜坡深度探测方法和探测车辆。

背景技术

自动驾驶汽车是一种通过电脑系统实现无人驾驶的智能汽车。自动驾驶汽车依靠人工智能、视觉计算、雷达、监控装置和全球定位系统协同合作，让电脑可以在没有任何人类主动的操作下，自动安全地操作机动车辆。精确定位，是自动驾驶汽车在复杂动态环境下安全有效运行所必须要解决的问题。在室外，可以依靠GPS技术对自动驾驶汽车进行定位。

然而，在封闭地下环境中，尤其是地下矿洞等环境，对于一些地下斜坡，无法依靠现有的气压法和GPS高度测量方法进行深度测量。因此，需要一种能够对封闭地下斜坡的深度进行准确测量的激光雷达地下斜坡深度探测方法。

发明内容

本发明要解决的技术问题在于，针对现有技术的上述缺陷，提供一种能够对封闭地下斜坡的深度进行准确测量的激光雷达地下斜坡深度探测方法和探测车辆。

本发明解决其技术问题所采用的技术方案是：构造一种激光雷达地下斜坡深度探测方法，包括：

S1、控制探测车辆沿着地下斜坡的顶部水平路面行驶，并通过设置在探测车辆上的激光雷达进行激光雷达扫描，并记录下激光雷达扫描时形成的雷达探测区域在垂直方向上的最低坐标以作为零点坐标；

S2、控制所述探测车辆沿着所述地下斜坡向下行驶并继续进行激光雷达扫描以记录形成的雷达探测区域在垂直方向上的最高坐标和最低坐标，同时通过设置在探测车辆上的传感器检测所述探测车辆的倾斜角度；

S3、当所述最高坐标等于所述零点坐标时且所述倾斜角度不为零的时候，计算所述最高坐标和所述最低坐标的差值以作为深度分值；

S4、将采用所述最低坐标替换所述零点坐标并返回步骤S2以获取多个深度分值，直至所述倾斜角度为0；

S5、将全部的深度分值相加以获得所述地下斜坡的深度。

在本发明所述的激光雷达地下斜坡深度探测方法中，进一步包括：控制所述激光雷达连续进行所述激光雷达扫描，并控制所述传感器连续进行角度检测。

在本发明所述的激光雷达地下斜坡深度探测方法中，进一步包括：在进行深度探测之前，控制所述探测车辆沿着所述地下斜坡行驶，以初始计算所述地下斜坡的斜坡长度，并基于所述斜坡长度设置所述探测车辆的行驶速度。

在本发明所述的激光雷达地下斜坡深度探测方法中，进一步包括：根据所述斜坡长度和所述倾斜角度计算所述地下斜坡的预估深度。

在本发明所述的激光雷达地下斜坡深度探测方法中，进一步包括：基于所述预估深度控制所述激光雷达根据设定时间间隔周期性进行所述激光雷达扫描，并控制所述传感器根据设定时间间隔周期性进行角度检测。

在本发明所述的激光雷达地下斜坡深度探测方法中，所述激光雷达每隔20ms进行一次激光雷达扫描。

在本发明所述的激光雷达地下斜坡深度探测方法中，所述探测车辆为自动驾驶电动工业车辆。

本发明解决其技术问题采用的另一技术方案是，构造一种探测车辆，包括设置在探测车辆上的激光雷达和传感器，所述探测车辆上存储有计算机程序，所述计算机程序被处理器执行时，控制所述探测车辆实现所述的激光雷达地下斜坡深度探测方法。