一种车辆轨迹预测方法和装置
    95.
    发明公开

    公开(公告)号:CN115060280A

    公开(公告)日:2022-09-16

    申请号:CN202210705025.6

    申请日:2022-06-21

    IPC分类号: G01C21/34 G06V20/58

    摘要: 本发明公开了一种车辆轨迹预测方法和装置,其包括:S1,获取障碍物车辆的实际历史轨迹;S2,根据障碍物车辆的预测位置和当前实际位置,计算得到预测位置误差,选择本次预测中所使用的历史轨迹时长;S3,根据实际历史轨迹,获得接近实际历史轨迹的拟合轨迹;S4,根据实际历史轨迹,计算符合障碍物车辆历史运动状态的障碍物车辆状态;S5,使用曲线拟合方程计算获得第一历史轨迹、使用运动学方程计算获得第二历史轨迹,再计算第一历史轨迹、第二历史轨迹分别与实际历史轨迹上对应轨迹点之间的误差;S6,在预设范围内对误差进行比较,选择本帧预测方法,以预测障碍物车辆的未来轨迹。

    一种目标形状及航向估计方法及系统

    公开(公告)号:CN113807442B

    公开(公告)日:2022-04-19

    申请号:CN202111097076.7

    申请日:2021-09-18

    摘要: 本发明公开了一种目标形状及航向估计方法及系统,该方法包括:步骤S1,获取原始的目标点云数据,并聚类;步骤S2,通过三维边界框描述聚类点云数据;步骤S3,将点云的x与y坐标沿一设定方向旋转预设步长;步骤S4,以三维边界框对应在xoy平面的平面矩形框的中心为原点,建立二维直角坐标系,根据点云特征点所处的象限和聚类点云数据中点云分布呈现的形状,计算目标函数值;步骤S5,判断当前航向角度是否处于设定遍历角度范围内,如果是,则返回步骤S3;反之,则进入步骤S6;步骤S6,选择最大的目标函数值对应的航向角为最优航向角;步骤S7,根据最优航向角对应的平面矩形框的中心在激光雷达坐标系下的位置,确定目标的最优三维边界框的位置、尺寸及姿态。