[发明专利]一种深度视频空间平面检测方法及系统

权利要求书

1.一种深度视频空间平面检测方法，其特征在于，包括如下步骤：

S1：对深度视频中当前帧的RGB图和深度图进行预处理，以得到所述当前帧的点云数据及位姿信息；

S2：从所述点云数据中选取满足如下方程的多组候选点，每组候选点包括三个候选点P₁、P₂及P₃，拟合得到多个候选平面，并从所述多个候选平面中获取初始平面P；

其中，，r₁、r₂及r₃分别是预设限值；

S3：基于所述初始平面P及其内点P_i，对所有内点P_i进行空间聚类，获取点数最多的类，所述类中的点为所述当前帧的检测平面的检测平面数据；

S4：根据所述深度视频中历史帧的历史输出平面数据及所述检测平面，获取当前输出平面。

2.根据权利要求1所述的深度视频空间平面检测方法，其特征在于，S2具体为：

S21：从所述点云数据中选取满足如下方程的多组候选点，每组候选点包括三个候选点P₁、P₂及P₃；

；

S22：针对多组候选点拟合得到多个候选平面；

S23：针对多个候选平面中每个，遍历所述点云数据，获取所述候选平面上的内点；

S24：选择内点数量最多的内点所属的候选平面为初始平面P。

3.根据权利要求1所述的深度视频空间平面检测方法，其特征在于，S3中对所有内点P_i进行空间聚类，具体为：

S31：在初始平面P中选择一点作为初始类的中心点P_ci，半径b_i为预设初始半径；

S32：遍历初始平面P上内点，计算所遍历点P_k与各中心点P_ci的距离S；

S33：判断S的大小，若S位于第一预设范围内，则将P_k聚类至中心点P_ci所属的类中；若S位于第二预设范围内，则将P_k聚类至中心点P_ci所属的类中，且采用如下公式更新中心点P_ci和半径b_i；若S位于第三预设范围内，则构建新类，并将P_k作为所述新类的中心点P_ci，且设定所述新类的半径b_i为所述预设初始半径；

其中为的归一化向量，所述第一预设范围、第二预设范围及第三预设范围依次增大；

S34：是否遍历完所述初始平面P上的内点，若否，返回S32，若是，结束。

4.根据权利要求3所述的深度视频空间平面检测方法，其特征在于，

所述初始类的中心点P_ci能够采用如下方程计算：

，其中n表示初始平面P上内点P_i的数量。

5.根据权利要求3所述的深度视频空间平面检测方法，其特征在于，所述第一预设范围为[0，0.5m]，第二预设范围为[0.5m，0.8m]，第三预设范围为[0.8m，+∞）。

6.根据权利要求3所述的深度视频空间平面检测方法，其特征在于，S4具体为：

S41：根据所述位姿信息，对所述检测平面数据进行配准处理，以获得所述当前帧的所述检测平面在世界坐标系下的平面点数据；

S42：至少选择所述平面点数据中不共线的三个点，拟合在世界坐标系下的平面；

S43：在所述世界坐标系下，判断所述当前帧的所述平面与所述历史帧的历史输出平面是否为同一个平面，若是，以将合并后的平面作为当前输出平面，若否，则将所述平面作为当前输出平面。