Do not fuse height after innovation consistency check fail
Introduce similar checks fo all other health checks in the filter
Merge pull request #1259 from PX4/ekf_fix

EKF filter fix
Merge branch 'master' into bennodiscovery
init
init