[发明专利]库位的检测方法及装置、存储介质和电子装置

权利要求书

1.一种库位的检测方法，其特征在于，包括：

基于由不同朝向的多个时间飞行ToF相机间的相对位置以及所述多个ToF相机的RGB图像建立三维体素概率地图；

根据所述三维体素概率地图和预设障碍物的垂直高度分布特征确定所述预设障碍物的语义；

根据预设库位模型和确定的所述预设障碍物的语义提取可停靠的库位的二维库位，并结合所述三维体素概率地图确定与所述二维库位对应的三维库位。

2.根据权利要求1所述的方法，其特征在于，所述基于由不同朝向的多个时间飞行ToF相机间的相对位置以及所述多个ToF相机的RGB图像建立三维体素概率地图，包括：

获取由不同朝向的多个时间飞行ToF相机间的相对位置标定结果将预设范围内的点云拼接成的广角点云；

基于特征点法确定所述RGB图像中相邻帧间相机自运动以确定前后帧间三维体的运动变化；

基于所述广角点云中的局部点云以及全局位置建立所述三维体素概率地图，并对所述三维体素概率地图中的体素概率值进行更新。

3.根据权利要求2所述的方法，其特征在于，所述获取所述多个ToF相机的RGB图像，并使用特征点法估计相邻帧间相机自运动以确定前后帧间三维体的运动变化，包括：

通过所述多个ToF相机获取相邻帧的RGB图像，并基于尺度不变特征变换SIFT算法分别提取相邻帧RGB图像中的特征点；

根据邻近算法对提取出的特征点进行匹配；

根据特征点的匹配结果计算相邻相机位置的变化以得到变化矩阵，并将所述变化矩阵作为视觉里程计。

4.根据权利要求2所述的方法，其特征在于，所述对所述三维体素概率地图中的体素概率值进行更新，包括：

在体素已被赋值的情况下，后续根据新的每帧点云结果对体素概率值进行更新，其中，更新的方式为：

L_new(n)＝max(min(L_old(n)+L(n)，l_max)，l_min)

其中L_new为更新后的网格概率值，L_old为更新前的网格概率值，p(n)为由当帧点云划分的概率值，l_min与l_max为概率限定阈值。

5.根据权利要求1所述的方法，其特征在于，所述根据所述三维体素概率地图和预设障碍物的垂直高度分布特征确定所述预设障碍物的语义，包括：

设置用于进行探测的三个高度区间，其中，所述三个高度区间包括以下至少之一：地面探测区间、底层障碍物探测区间、高层障碍物探测区间；

对所述三个高度区间进行直通滤波获取与所述三个高度区间对应范围内的体素集合；

根据与所述不同高度区间对应的体素集合确定所述预设障碍物的分布区间及几何特征对障碍物进行语义判断，以确定所述预设障碍物的语义。

6.根据权利要求1所述的方法，其特征在于，所述根据预设库位模型和确定的所述预设障碍物的语义提取可停靠的库位的二维库位，并结合所述三维体素概率地图确定与所述二维库位对应的三维库位，包括：

根据预设库位模型中水平面二维预设障碍物的分布结果查找表征空位库位的二维库位；

基于所述二维库位的平面位置，以预设长度作为步长向车库顶面方向增长，组成三维包围盒；

在所述三维包围盒内包含的障碍物的体素个数超过预设阈值的情况下，确定触碰到障碍物，并记录为库位竖直方向上最大高度值；

从所述最大高度值中取地面分割结果中的高度值作为地面高度值，并将所述地面高度值作为三维库位的限高值；

将所述二维库位与所述限高值组成所述三维库位。