卡尔曼滤波
卡尔曼滤波（Kalman Filter）是一种用于估计系统状态的数学算法，不是类似于高通、低通滤波器那样的频域滤波。
卡尔曼滤波基于线性动态系统的假设，它将系统的状态表示为均值和协方差矩阵，通过递归地更新和预测这些值来实现对系统状态的估计。卡尔曼滤波有两个主要的步骤：预测和更新。
卡尔曼滤波具有一些优点，例如对噪声和不确定性的鲁棒性较强，能够提供较为精确的估计结果，并且计算效率较高。然而，卡尔曼滤波的应用前提是系统满足线性动态系统的假设，对于非线性系统，需要通过扩展卡尔曼滤波（Extended Kalman Filter）或无迹卡尔曼滤波（Unscented Kalman Filter）等变种算法来进行处理。
滤波结构
-
预测步骤中，卡尔曼滤波使用系统模型和上一时刻的状态估计来预测当前时刻的状态，并计算出预测状态的均值和协方差矩阵。
-
更新步骤中，