Code: Add innovation plots
estimator_23states: reduce code size
estimator_23states: fix bug in covariance initialisation
estimator_23_states: remove zeroing of vel and pos innovation variances
Not For Flight: Debug Code to disable GPS consistency checks