一种实现卡尔曼滤波定位的方法和装置与流程

文档序号:11385276阅读:来源:国知局

技术特征:

技术总结
本文公布了一种实现卡尔曼滤波定位的方法和装置,包括:根据上一个历元时状态向量的预测值和上一个历元时误差协方差矩阵计算当前历元时状态向量的最优估计值和当前历元时状态向量的最优估计值的误差协方差矩阵;对于当前历元时状态向量的最优估计值中的每一个元素,计算该元素上上一个历元时最优估计值和当前历元时最优估计值之间的平均值,和上一个历元时最优估计值之间的差值;判断出一个或多个元素对应的计算得到的差值小于或等于预设阈值,将当前历元时最优估计值删除一个或多个元素,将当前历元时最优估计值的误差协方差矩阵删除对应的一个或多个元素,再继续执行计算下一个历元时状态向量的预测值,计算下一个历元时误差协方差矩阵的步骤。

技术研发人员:宋挥师;赵海龙;徐雄伟;刘晓燕;孙涛;刘航
受保护的技术使用者:大唐半导体设计有限公司
技术研发日:2016.02.26
技术公布日:2017.09.05
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1