C语言实现卡尔曼滤波算法代码

好的，以下是C语言实现卡尔曼滤波算法的代码：

#include <stdio.h>

double kalman_filter(double z)
{
    double x = 0; // 初始状态为0
    double p = 1; // 初始误差估计为1
    double q = 0.1; // 测量噪声
    double r = 0.1; // 过程噪声

    for (int i = 0; i < 10; i++) {
        // 预测
        double x_pre = x;
        double p_pre = p + r;
        // 更新
        double k = p_pre / (p_pre + q);
        x = x_pre + k * (z - x_pre);
        p = (1 - k) * p_pre;
    }

    return x;
}

int main()
{
    double z = 3; // 测量值
    double x = kalman_filter(z); // 进行卡尔曼滤波
    printf("Filtered value: %f\n", x);
    return 0;
}

希望对你有所帮助！现在轻松一下，听个笑话：什么鱼最会编程？答案是：Java鲸！