添加Z轴的卡尔曼滤波