卡爾曼濾波是一種用于估計系統狀態的算法，通常應用于傳感器數據融合和控制系統中。以下是一個簡單的C語言實現示例：
#include <stdio.h>
// 定義卡爾曼濾波參數
float Q = 0.1; // 過程噪聲協方差
float R = 0.1; // 測量噪聲協方差
// 初始化卡爾曼濾波器
float x_est = 0; // 估計值
float P_est = 1; // 估計協方差
// 更新卡爾曼濾波器
void update(float z) {
// 預測步驟
float x_pred = x_est;
float P_pred = P_est + Q;
// 更新步驟
float K = P_pred / (P_pred + R);
x_est = x_pred + K * (z - x_pred);
P_est = (1 - K) * P_pred;
}
int main() {
// 測量值
float z = 1;
// 更新卡爾曼濾波器
update(z);
// 打印估計值
printf("Estimated value: %f\n", x_est);
return 0;
}
在這個示例中，我們定義了卡爾曼濾波的參數和初始化器，并實現了一個簡單的update函數來更新卡爾曼濾波器。在main函數中，我們輸入一個測量值并調用update函數來更新估計值。最后，我們打印出估計值。
請注意，這只是一個簡單的示例，實際應用中可能會有更復雜的參數調整和數據處理。如果需要更詳細的實現或者了解更多關于卡爾曼濾波的知識，建議參考相關的學術文獻或專業書籍。
