·上一文章:基于多总线的自动检定/校准测试系统设计
·下一文章:基于PLC的物料自动控制系统
2.2.1 数据融合的联合卡尔曼滤波模型
此滤波算法中,取βm=0,即主滤波器没有信息输入,进一步优化系统,减少了运算量。
2.2.2 系统滤波算法步骤
(1)由局部滤波器l处理GPS接收机输出的列车位置信息,并给出状态估计x1和估计误差的协方差矩阵p1;
(2)局部滤波器2处理陀螺仪和里程仪输出的角度信息x2和列车运行距离信息,给出状态估计和估计误差的协方差矩阵p2;
(3)局部滤波器3处理查询应答器输出的进路长度等信息,给出状态估计x3和估计误差的协方差矩阵p3;
(4)x1,x2,x3,及p1,p2,p3被送到主滤波器,并同主滤波器的状态估计一起按式(1)和式(2)进行融合,得到全局最优估计和协方差矩阵
(5)利用主滤波器的最优估计值对3个子滤波器的状态估计进行重置。即
2.2.3 信息分配参数的选择
不同的信息分配系数可以获得联邦滤波器的不同结构以及不同的容错性能、滤波精度和计算量。本方案中设计了一种自适应联邦卡尔曼滤波器。利用GPS接收机输出的反映定位精度的参数为依据,自动调整P值的大小。本定位系统根据GPS接收机的p值大小来决定取值。具体的自适应算法为