c++封装的卡尔曼滤波

今天用c++ 写了 一个卡尔曼的小样,比较简单,分享给大家,后期有可能也会修改。
以后也会慢慢的把其他的 自己写的代码分享给大家。
本人还是个 小白,写的不好轻喷。

因为传入的参数都比较简单,所以测量和观测矩阵都是用的单位矩阵

这个是在ubuntu 下用Qt写的,不过是用cmake编译的,中间用了eigen这个库,第一次用,还是不太熟悉

main.cpp
#include "kalman.h"
class KalmanFilter;
int main(int argc, char *argv[])
{
    double ran_num;
    Eigen::Matrix<double, 4, 1> test1  ;
    Eigen::Matrix<double, 4, 1> test2  ;
    KalmanFilter kf(2,2);
    while(1){
        for(int i =0 ; i<4 ; i++){
            ran_num = rand()%9+100;
            test1(i,0) =(double) ran_num;
        }
        test2 = kf.updata_paramount(test1);
        for( int j =0; j<4 ;j++){
             std::cout<< test2(j,0) 
  • 2
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 6
    评论
评论 6
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值