Proper zero init of the filter
Safety checks, prepared to use GPS variance
Merge branch 'ekf_params' of github.com:PX4/Firmware into ekf_params