altoslib: Missed a couple of easy mini voltage API changes
[fw/altos] / src / core / ao_kalman.c
index 762b2c0a45749f2b1cba48d685601bcead0f0cff..9aea1f14762f6139d9fb8dce932b98a6c946068d 100644 (file)
@@ -166,7 +166,7 @@ ao_kalman_err_accel(void)
 {
        int32_t accel;
 
-       accel = (ao_ground_accel - ao_sample_accel) * ao_accel_scale;
+       accel = (ao_config.accel_plus_g - ao_sample_accel) * ao_accel_scale;
 
        /* Can't use ao_accel here as it is the pre-prediction value still */
        ao_error_a = (accel - ao_k_accel) >> 16;
@@ -292,7 +292,4 @@ ao_kalman(void)
        else 
 #endif
                ao_avg_height = (ao_avg_height_scaled + 63) >> 7;
-#ifdef AO_FLIGHT_TEST
-       ao_sample_prev_tick = ao_sample_tick;
-#endif
 }