RTKLIB软件源码学习(Kalman滤波&最小二乘)

由于RTKLIB源码的最小二乘和kalman滤波函数邻近,这里直接一起解读。函数部分整体并不难,在了解初级矩阵函数的使用后就可以知道每一步代表的意思。

首先是kalman的核心公式,这里仅基于公式进行代码解读

预测:A是状态矩阵,B是控制矩阵,H是传输矩阵,D是前馈矩阵

           \hat{x} _{\bar{k}}=A_{k}\hat{x}_{k-1}+B_{k}u_{k}

           p_{\bar{k}}=A_{k}P_{k-1}A_{k}^{T}+Q

    预测中\hat{x}_{k-1} 、P_{k-1}使用的是上一次计算得到的\hat{x}_{k}P_{k}

更新:

           

  • 3
    点赞
  • 15
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值