卡尔曼滤波器

~ 参考

　　http://blog.chinaunix.net/uid-26694208-id-3184442.html

　　http://blog.sina.com.cn/s/blog_7445c2940102whjq.html

　　http://blog.csdn.net/qq_18163961/article/details/52505591