c++封装的卡尔曼滤波

博主分享了一段使用C++编写的简单卡尔曼滤波器代码,该代码在Ubuntu环境下借助Qt和CMake进行编译,利用了Eigen库,但博主表示自己对Eigen库尚不熟悉。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

今天用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) <<"     "<<  test1(j,
评论 6
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值