[发明专利]一种车辆轨迹预测方法、装置、芯片、终端和计算机设备有效
申请号: | 202210578437.8 | 申请日: | 2022-05-26 |
公开(公告)号: | CN114664094B | 公开(公告)日: | 2022-08-26 |
发明(设计)人: | 杨清源;魏辉;高玉 | 申请(专利权)人: | 青岛慧拓智能机器有限公司 |
主分类号: | G08G1/01 | 分类号: | G08G1/01;G08G1/123 |
代理公司: | 北京中强智尚知识产权代理有限公司 11448 | 代理人: | 黄耀威 |
地址: | 266100 山东省青岛市高新技术产业*** | 国省代码: | 山东;37 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 车辆 轨迹 预测 方法 装置 芯片 终端 计算机 设备 | ||
1.一种车辆轨迹预测方法,其特征在于,包括:
根据不同行驶时刻车辆的大地坐标和航向角,确定相对于起始时刻的车体坐标系的相对坐标系;
获取不同行驶时刻所述车辆在所述相对坐标系下的横向位移、纵向速度以及纵向加速度,并根据所述横向位移、所述纵向速度以及所述纵向加速度,生成观测状态序列;
基于所述观测状态序列和不同行驶行为对应的行为识别模型,对所述车辆的行驶行为进行识别;其中,确定不同行驶行为对应的行为识别模型包括:获取样本观测状态序列,根据所述样本观测状态序列的最大横向位移将所述样本观测状态序列分类为与所述不同行驶行为识别模型对应的样本观测状态序列,应用所述样本观测状态序列对相应的不同行驶行为识别模型进行训练得到不同行驶行为识别模型的参数;
基于所述观测状态序列和预设多项式,生成不同行驶行为的轨迹曲线集合,以及在所述不同行驶行为的轨迹曲线集合中,确定与识别到的所述车辆的行驶行为对应的目标轨迹曲线集合;
根据所述观测状态序列在所述目标轨迹曲线集合中确定所述车辆的轨迹曲线。
2.根据权利要求1所述的方法,其特征在于,所述根据不同行驶时刻车辆的大地坐标和航向角,确定相对于起始时刻车体坐标系的相对坐标系,包括:
获取所述车辆在大地坐标系下的不同行驶时刻的大地坐标和航向角,并根据所述大地坐标和所述航向角生成坐标变换矩阵;
根据所述坐标变换矩阵,得到所述车辆相对于起始时刻的车体坐标系下的相对坐标和航向角;
当所述航向角在连续时间内的变化量均小于第一阈值时,以当前时刻的车体坐标系为所述相对坐标系;
当所述航向角在连续时间内的至少一个变化量大于所述第一阈值时,以当前时刻的前一时刻的车体坐标系为所述相对坐标系。
3.根据权利要求2所述的方法,其特征在于,所述获取不同行驶时刻所述车辆在所述相对坐标系下的横向位移、纵向速度以及纵向加速度,包括:
获取不同行驶时刻所述车辆在所述相对坐标系下的相对坐标的横向位移和纵向位移;
根据所述纵向位移和时间间隔,求取不同行驶时刻的所述纵向速度和所述纵向加速度。
4.根据权利要求2所述的方法,其特征在于,在所述根据所述横向位移、所述纵向速度以及所述纵向加速度,生成观测状态序列之前,还包括:
采用卡尔曼滤波算法对所述横向位移、所述纵向速度以及所述纵向加速度进行滤波处理。
5.根据权利要求1所述的方法,其特征在于,所述根据所述横向位移、所述纵向速度以及所述纵向加速度,生成观测状态序列,包括:
根据起始时刻对应的观测状态S0={y0,vx0,ax0},求取时间序列T={t1,t2,t3,......,tn}对应的观测状态St={S1,S2,S3,......,Sn},则所述观测状态序列Ot={O1,O2,O3,......,On}={S1-S0,S2-S0,S3-S0,......,Sn-S0},其中,y0为所述横向位移,vx0为所述纵向速度,ax0为所述纵向加速度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于青岛慧拓智能机器有限公司,未经青岛慧拓智能机器有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210578437.8/1.html,转载请声明来源钻瓜专利网。