▍1. KalmanFiltering
扩展卡尔曼滤波算法C语言实现:实现对二维状态变量的预测及跟踪。包括卡尔曼滤波初始化函数,负责初始化状态变量的值,过程噪声,测量噪声,以及状态转移矩阵。 卡尔曼滤波函数负责对状态变量进行迭代滤波,整个过程包括状态预测,协方差预测,测量预测,计算卡尔曼增益,状态量更新,协方差更新。(To realize the prediction and tracking of two dimensional state variables. It includes the initialization function of Kalman filter, which is responsible for initializing the value of state variables, process noise, measurement noise, and state transfer matrix. Kalman filter function is responsible for iterative filtering of state variables. The whole process includes state prediction, covariance prediction, measurement and prediction, computing Kalman gain, updating state variables and updating covariance.)