公开(公告)号：CN116627133A

公开(公告)日：2023-08-22

申请号：CN202310591134.4

申请日：2023-05-24

Applicant: 重庆大学

Inventor： 柴毅 ,  屈剑锋 ,  王粤 ,  郑灿 ,  赵俊

IPC: G05D1/02

Abstract: 本发明公开了一种面向自动驾驶场景的环卫车换道轨迹规划方法，首先将自动驾驶环卫车换道轨迹规划解耦为换道路径规划和换道速度规划，基于三次准均匀B样条曲线规划稳定的、能躲避本车道前方静态障碍物的备选换道路径簇，并基于所建立的多目标评奖函数筛选出满足安全性、舒适性以及车辆运动学的最优换道路径，并基于S‑T图利用动态规划的思想在图中可行域搜索出能躲避动态障碍车的初始速度曲线簇，并建立最优初始速度曲线。然后利用二次规划算法对最优初始曲线进行优化，利用所搭建的仿真场景对上述换道路径规划算法和换道速度规划算法进行仿真验证，结果表明了本发明的换道路径规划算法和换道速度规划算法的有效性和合理性。

公开(公告)号：CN116503490A

公开(公告)日：2023-07-28

申请号：CN202310582845.5

申请日：2023-05-23

Applicant: 重庆大学

Inventor： 柴毅 ,  屈剑锋 ,  龚思宇 ,  王粤 ,  陈了

IPC: G06T7/80 ,  G06T7/30 ,  G06T17/00 ,  G06F17/16

Abstract: 本发明公开了一种面向移动状态下大尺度长方体的三维形貌方法，在点云分割和降噪方面，建立了直通滤波算法、半径滤波方法和RANSAC平面分割方法，获得了有效区域的物体点云数据集，减少了无关区域数据和噪声的干扰。在点云降采样方面，建立了改进VoxelGrid滤波算法，从而实现在不影响目标对象表面细节和特征的情况下适当降低点云数据的密度。根据采集的方式与长方体物体形状的几何特征，使用PCA方法计算特征向量，使第一和第二主轴反向获得了粗旋转矩阵，利用质心计算平移向量的方法进行了粗配准。然后使用点面ICP算法进行了精配准，获得了大尺度立方体物体的配准点云集。最后通过贪婪投影对配准点云进行了曲面重建，获得了大尺度立方体物体的三维形貌模型。