Fixed a bug with the minimization.
Increasing the volatility of the preturbation.
Merge branch 'master' of https://github.com/hildingur/filtering

Conflicts:
	filtering/final_ekf.cpp