diff --git a/sw/airborne/estimator.c b/sw/airborne/estimator.c index d4ce1f637c..fbf67651e4 100644 --- a/sw/airborne/estimator.c +++ b/sw/airborne/estimator.c @@ -201,7 +201,9 @@ void alt_kalman(float gps_z) { p[1][1] = -p[0][1]*k_1+p[1][1]; } +#ifdef DEBUG_ALT_KALMAN DOWNLINK_SEND_ALT_KALMAN(&(p[0][0]),&(p[0][1]),&(p[1][0]), &(p[1][1])); +#endif } #endif