老外写的卡尔曼滤波经典教材,里面包含了很多编程实现卡尔曼滤波算法的例子。