卡尔曼滤波算法(C一一C++两种实现代码).docVIP

卡尔曼滤波算法实现代码 C++实现代码如下： ============================kalman.h================================//?kalman.h:?interface?for?the?kalman?class.////////////////////////////////////////////////////////////////////////#if?!defined(AFX_KALMAN_H__ED3D740F_01D2_4616_8B74_8BF57636F2C0__INCLUDED_)#define?AFX_KALMAN_H__ED3D740F_01D2_4616_8B74_8BF57636F2C0__INCLUDED_#if?_MSC_VER??1000#pragma?once#endif?//?_MSC_VER??1000#include?math.h#include?cv.h?class?kalman??{public:?void?init_kalman(int?x,int?xv,int?y,int?yv);?CvKalman*?cvkalman;?CvMat*?state;??CvMat*?process_noise;?CvMat*?measurement;