[发明专利]基于卡尔曼滤波的定位方法、系统、设备及存储介质有效

专利信息
申请号: 201910139232.8 申请日: 2019-02-25
公开(公告)号: CN109883423B 公开(公告)日: 2021-02-09
发明(设计)人: 陈辞;高民;张弢;张骁;王周红 申请(专利权)人: 广州市香港科大霍英东研究院
主分类号: G01C21/20 分类号: G01C21/20
代理公司: 广州三环专利商标代理有限公司 44202 代理人: 麦小婵;郝传鑫
地址: 511458 广东省*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 基于 卡尔 滤波 定位 方法 系统 设备 存储 介质
【权利要求书】:

1.一种基于卡尔曼滤波的定位方法,其特征在于,包括:

获取智能终端的当前时刻航向角与上一时刻航向角,并计算所述当前时刻航向角与所述上一时刻航向角的航向角差值;

根据所述航向角差值,通过预测更新方程预测当前时刻的状态向量并更新误差协方差矩阵;

当未接收到定位模块的定位输出时,根据所述状态向量,获取智能终端的位置;

当接收到所述定位模块的定位输出时,获取所述定位模块的定位输出,作为测量值;

根据所述测量值,通过测量更新方程更新所述状态向量和误差协方差矩阵;

根据更新后的当前时刻的状态向量,获取所述智能终端的位置。

2.如权利要求1所述的基于卡尔曼滤波的定位方法,其特征在于,所述方法还包括:

根据接收到的所述定位模块输出的初始定位坐标、预设的初始速度以及预设的初始航向角对差分方向卡尔曼滤波器进行初始化处理。

3.如权利要求1所述的基于卡尔曼滤波的定位方法,其特征在于,所述根据所述航向角差值,通过预测更新方程预测当前时刻的状态向量并更新误差协方差矩阵包括:

通过预设的匀速运动模型,更新差分方向卡尔曼滤波器的状态转移矩阵;

根据所述航向角差值,计算所述差分方向卡尔曼滤波器的激励矩阵以及激励输入值;

通过预设的准静态白噪声模型,更新所述差分方向卡尔曼滤波器的噪声矩阵;

根据所述状态转移矩阵、所述激励矩阵、所述激励输入值以及所述噪声矩阵,通过预测更新方程预测当前时刻的状态向量并更新误差协方差矩阵。

4.如权利要求3所述的基于卡尔曼滤波的定位方法,其特征在于,所述预设的匀速运动模型为:

其中,xk和yk分别表示智能终端在时刻k时水平坐标系x轴和y轴的坐标,vxk和vyk分别表示智能终端在时刻k时水平坐标系x和y轴的速度,dtk为状态更新的时间间隔;

所述差分方向卡尔曼滤波器的状态转移矩阵为:

5.如权利要求4所述的基于卡尔曼滤波的定位方法,其特征在于,所述根据所述航向角差值,计算所述差分方向卡尔曼滤波器的激励矩阵以及激励输入值,具体包括:

根据所述航向角差值,确定所述差分方向卡尔曼滤波器的差分方向旋转矩阵;

通过所述差分方向旋转矩阵旋转所述状态向量中的速度矢量,并根据旋转后的速度矢量以及所述状态向量中的速度矢量,计算所述差分方向卡尔曼滤波器的激励输入值:

其中,vk=[vxk vyk]T,表示状态向量中的速度矢量;表示旋转后的速度矢量,Rotk表示差分方向旋转矩阵,当方位角为顺时针方向夹角时,当方位角为逆时针夹角时,

根据所述激励输入值,确定匀变速运动下所述激励输入值对所述智能终端速度和位置的改变量:

根据所述激励输入值对所述智能终端的速度和位置的改变量,确定所述差分方向卡尔曼滤波器的激励矩阵:

6.如权利要求5所述的基于卡尔曼滤波的定位方法,其特征在于,所述预测更新方程为:

其中,和为对k时刻的状态向量和误差协方差矩阵的预测,sk-1=[xk-1,vxk-1,yk-1,vyk-1]T,为速度白噪声方差;

所述测量更新方程为:

其中,H表示测量矩阵,Rk表示测量误差协方差矩阵,zk为测量向量,Pk为状态的误差协方差。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广州市香港科大霍英东研究院,未经广州市香港科大霍英东研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201910139232.8/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top