C++实现的的卡尔曼滤波,本人在机器人大赛中实际使用过。