[发明专利]一种自动泊车定位系统的航迹推算方法有效
申请号: | 201910243714.8 | 申请日: | 2019-03-28 |
公开(公告)号: | CN110077392B | 公开(公告)日: | 2020-08-25 |
发明(设计)人: | 王德祥 | 申请(专利权)人: | 惠州市德赛西威汽车电子股份有限公司 |
主分类号: | B60W30/06 | 分类号: | B60W30/06 |
代理公司: | 广州粤高专利商标代理有限公司 44102 | 代理人: | 陈卫;练逸夫 |
地址: | 516006 广东省*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种自动泊车定位系统的航迹推算方法,包括步骤:计算泊车第一时刻车辆航向定位值;通过泊车第一时刻车辆航向定位值结合车辆运动信息计算得到泊车第二时刻车辆航向定位值的系统矩阵、测量矩阵以及观察量;通过线性卡尔曼滤波算法对其分别进行滤波估算以得到泊车第二时刻车辆航向定位值;将泊车第二时刻车辆航向定位值的车辆航向角与计算得到的泊车第二时刻车辆零飘误差值进行相减运算,以得到泊车第二时刻确定车辆航向定位值。本发明以航迹推算的结果作为测量量结合车辆的横摆角速度及车辆后轴中心的速度等参数采用线性卡尔曼滤波算法对其进行滤波估算以得到车辆实时定位的航迹推算值,然后消除零飘误差,得到精准实时航向定位值。 | ||
搜索关键词: | 一种 自动 泊车 定位 系统 航迹 推算 方法 | ||
【主权项】:
1.一种自动泊车定位系统的航迹推算方法,其特征在于,包括如下步骤:计算泊车第一时刻车辆航向定位值;通过泊车第一时刻车辆航向定位值结合车辆运动信息计算得到泊车第二时刻车辆航向定位值的系统矩阵、测量矩阵以及观察量;通过线性卡尔曼滤波算法对泊车第二时刻车辆航向定位值的系统矩阵、测量矩阵以及观察量分别进行滤波估算以得到泊车第二时刻车辆航向定位值;通过车身偏航率传感器值计算泊车第二时刻车辆零飘误差值;将泊车第二时刻车辆航向定位值的车辆航向角与泊车第二时刻车辆零飘误差值进行相减运算,以得到泊车第二时刻确定车辆航向定位值。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于惠州市德赛西威汽车电子股份有限公司,未经惠州市德赛西威汽车电子股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201910243714.8/,转载请声明来源钻瓜专利网。