--> changed ecuations of EKF
--> Fixes in matlab scripts