MADE:
--> Corrected errors in EKF (ground tracking)
--> Added test's Results

TODO:
--> Add images and add to document