Description: The filter was applied to trajectory of body that start motion on the ground with velocity start at angle 40 degrees. First part of the code generate this motion. Nose added to simulate nose of measurement or nose of object detection recognition. Then kalman filter applied and trajectory and velocity found.