卡尔曼滤波算法(含详细推导),写得很详细,推荐阅读。