卡尔曼滤波程序,调试通过,绝对正确! 运行平台:Visual C++6.0,Opencv1.0