三维情况下的kalman跟踪系统,其中状态量包括x,y,z三个方向的位移和速度,测量方程为空间两点求距离的方程。