Fixing base EKF and UKF tests
Merge pull request #150 from ayrton04/master

Fixing base EKF and UKF tests