Fixing base EKF and UKF tests
Merge pull request #147 from ayrton04/jade-devel

Fixing base EKF and UKF tests