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