run kalman_filter.m see description.docx and reference_1.png reference_2.png
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.