关于卡曼滤波的程序，不过可能是matlab写得，可以简单转化下，如果要在c中实用的话-Kalman filter on the procedure, but may be written in Matlab, a simple conversion, If it is to be practical, c the