Do not use full EKF on start
Merge branch 'hcostelha'