Just some EKF tweaks.
Merged files.
Probably some bug fixes were done in this version. Also tweaks in the EKF constants.