一种预测车辆运动轨迹的方法及装置.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN114228746A(43)申请公布日2022.03.25(21)申请号202210050559.X(22)申请日2022.01.17(71)申请人北京经纬恒润科技股份有限公司地址100015北京市朝阳区酒仙桥路14号1幢4层(72)发明人颜学术李继扬(74)专利代理机构北京集佳知识产权代理有限公司11227代理人陈志海(51)Int.Cl.B60W60/00(2020.01)权利要求书3页说明书15页附图6页(54)发明名称一种预测车辆运动轨迹的方法及装置(57)摘要本发明提供了一种预测车辆运动轨迹的方法及装置，利用所采集的指定目标车辆的绝对运动状态，确定平均运动学参数并据此预测待处理运动轨迹；基于待处理运动轨迹和指定目标车辆的历史运动轨迹，预测得到初始行驶意图；确定指定目标车辆所在车道的道线类型，及确定障碍车辆信息；利用道线类型和障碍车辆信息，对初始行驶意图进行滤波处理，得到最终行驶意图并据此确定横向目标位置；利用横向目标位置和平均运动学参数，预测指定目标车辆的车辆运动轨迹。该方法对硬件算力的要求较低，并且能够快速定位哪一环节出现异常，进而及时解决异常以提高安全性。CN114228746ACN114228746A权利要求书1/3页1.一种预测车辆运动轨迹的方法，其特征在于，所述方法应用于搭载在车辆中的预测车辆运动轨迹的装置，所述方法包括：从检测到的目标车辆中确定指定目标车辆；利用在多个历史周期中采集的所述指定目标车辆的绝对运动状态，确定得到平均运动学参数，并基于所述平均运动学参数预测所述指定目标车辆的待处理运动轨迹，所述平均运动学参数用于描述所述指定目标车辆在所述多个历史周期中的平均运动状态；基于所述待处理运动轨迹和所述指定目标车辆的历史运动轨迹，计算所述指定目标车辆的运动特征向量的归一化均值；将所述归一化均值映射到预设数值区间中得到行驶意图数值，并根据所述行驶意图数值预测得到初始行驶意图；扫描所述指定目标车辆的周边环境，得到所述指定目标车辆所在车道的道线类型，及得到与所述指定目标车辆所在车道相邻的车道中的障碍车辆信息；利用所述道线类型和所述障碍车辆信息，对所述初始行驶意图进行滤波处理，预测得到最终行驶意图；基于所述最终行驶意图确定横向目标位置；利用所述横向目标位置和所述平均运动学参数，预测所述指定目标车辆从当前位置到目标位置的车辆运动轨迹。2.根据权利要求1所述的方法，其特征在于，利用在多个历史周期中采集的所述指定目标车辆的绝对运动状态，确定得到平均运动学参数，并基于所述平均运动学参数预测所述指定目标车辆的待处理运动轨迹，包括：确定多个历史周期的时间间隔；将在所述多个历史周期中采集的所述指定目标车辆的绝对运动状态除以所述时间间隔，得到平均运动学参数；利用运动学模型对所述平均运动学参数进行处理，预测所述指定目标车辆的待处理运动轨迹。3.根据权利要求1所述的方法，其特征在于，基于所述待处理运动轨迹和预先存储的所述指定目标车辆的历史运动轨迹，计算所述指定目标车辆的运动特征向量的归一化均值，包括：组合所述待处理运动轨迹和预先存储的所述指定目标车辆的历史运动轨迹，得到输入运动轨迹；利用车道线表达式，计算所述输入运动轨迹对应的车道中心线的中心线横向位置和道线航向角；对于所述输入运动轨迹中所述指定目标车辆的车辆横向位置和车辆航向角，计算所述车辆横向位置与所述中心线横向位置之间的横向位置偏差，以及计算所述车辆航向角与所述道线航向角之间的航向角偏差；将所述横向位置偏差除以车道宽度以归一化所述横向位置偏差，并对所有归一化后的所述横向位置偏差取平均值，确定得到所述横向位置偏差的归一化均值；将所述航向角偏差除以所述指定目标车辆的最大航向角以归一化所述航向角偏差，并对所有归一化后的所述航向角偏差取平均值，确定得到所述航向角偏差的归一化均值，所2CN114228746A权利要求书2/3页述指定目标车辆的最大航向角基于所述指定目标车辆的车速计算得到。4.根据权利要求3所述的方法，其特征在于，将所述归一化均值映射到预设数值区间中得到行驶意图数值，并根据所述行驶意图数值预测得到初始行驶意图，包括：利用基于S型函数得到的非线性映射函数，将所述横向位置偏差的归一化均值映射到预设数值区间中得到第一行驶意图数值，以及将所述航向角偏差的归一化均值映射到所述预设数值区间得到第二行驶意图数值；在所述第一行驶意图数值和所述第二行驶意图数值满足左侧换道规则的情况下，预测初始行驶意图为左侧换道意图，其中，所述左侧换道规则为：所述第一行驶意图数值处于第一左侧换道数值区间内，且所述第二行驶意图数值处于第二左侧换道数值区间内；在所述第一行驶意图数值和所述第二行驶意图数值满足右侧换道规则的情况下，预测初始