基于方向和距离的扩展卡尔曼状态估计maltba仿真

基于距离和方向的扩展卡尔曼状态估计maltba仿真。3维场景下，测量得到目标的距离和方位，通过扩展卡尔曼估计目标的位置和速度信息。适用于目标匀速运动的情况。