[发明专利]一种基于车辆轨迹点生成行驶路线的方法和装置在审
申请号: | 202111467870.6 | 申请日: | 2021-12-03 |
公开(公告)号: | CN114184206A | 公开(公告)日: | 2022-03-15 |
发明(设计)人: | 李鹏;余效伟;云小龙;史翔宇;石建;余效仁;张东勤;余期发 | 申请(专利权)人: | 北京车慧达科技有限公司 |
主分类号: | G01C21/34 | 分类号: | G01C21/34 |
代理公司: | 北京细软智谷知识产权代理有限责任公司 11471 | 代理人: | 涂凤琴 |
地址: | 102400 北京市房山*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 车辆 轨迹 生成 行驶 路线 方法 装置 | ||
1.一种基于车辆轨迹点生成行驶路线的方法,其特征在于,所述方法包括:
采集车辆行驶过程中的实际行驶点数据;
对所述实际行驶点数据进行拟合,得到车辆行驶路线轨迹。
2.根据权利要求1所述的方法,其特征在于,所述对所述实际行驶点数据进行拟合,得到车辆行驶路线轨迹,包括:
利用预设的B样条曲线方程对所述实际行驶点数据进行拟合,得到车辆行驶路线轨迹。
3.根据权利要求2所述的方法,其特征在于,所述方法还包括:获取所述预设的B样条曲线方程。
4.根据权利要求3所述的方法,其特征在于,所述获取所述预设的B样条曲线方程,包括:
步骤1:在每个所述实际行驶点数据的两侧各增加一个虚拟行驶点数据;
其中,令Pi为第i个所述实际行驶点数据,i∈[1,n],n为所述实际行驶点数据的总数量;令Ai,0为第i个所述实际行驶点数据Pi一侧的虚拟行驶点数据,Ai,1为第i个所述实际行驶点数据Pi另一侧的虚拟行驶点数据;
步骤2:令第一个所述实际行驶点数据P1和其两侧的虚拟行驶点数据重叠,即A1,0=A1,1=P1;
令第n个所述实际行驶点数据Pn和其两侧的虚拟行驶点数据重叠,即An,0=An,1=Pn;
步骤3:按下式确定虚拟行驶点的坐标:
上式中,h为系数,0h1;
步骤4:按下式确定预设的B样条曲线方程C(u):
上式中,Bi,k(u)是第i个k次B样条基函数,u为节点;其中,k=3。
5.根据权利要求4所述的方法,其特征在于,所述步骤1,包括:
令Ai,0、Pi和Ai,1位于同一条直线上,且Ai,0、Pi和Ai,1所在的直线平行于Pi-1和Pi+1所在的直线上
Ai,0和Pi所在的直线的长度与Pi和Ai,1所在的直线的长度、Pi-1和Pi+1所在的直线的长度之间的关系是:
6.根据权利要求4所述的方法,其特征在于,所述步骤4,包括:
按下式确定B样条基函数Bi,k(u):
上式中,ui为第i个节点,节点向量集合U={u0,u1,…,ui,…,un+k+1}。
7.一种基于车辆轨迹点生成行驶路线的装置,其特征在于,所述装置包括:
采集模块,用于采集车辆行驶过程中的实际行驶点数据;
拟合模块,用于对所述实际行驶点数据进行拟合,得到车辆行驶路线轨迹。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京车慧达科技有限公司,未经北京车慧达科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111467870.6/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种工业销轴倒角小型设备
- 下一篇:一种桶装溶液全自动吸料机及吸料方法