estimator_23states: Filter Stability Improvements

This patch changes the way that magnetometer, wind and terrain offset state
updates are inhibited to reduce the likelihood of an ill-conditioned covariance
matrix forming
Code: Add innovation plots
Not For Flight: Debug Code to disable GPS consistency checks