本代码为容积卡尔曼算法的简单程序，仅用于个人研究卡尔曼滤波，不可用于其他用途。转发注明出处。