diff --git a/bbn_wave_freq_m5atomS3/KalmanForWaveAlt.h b/bbn_wave_freq_m5atomS3/KalmanForWaveAlt.h index ff16b28..66cc750 100644 --- a/bbn_wave_freq_m5atomS3/KalmanForWaveAlt.h +++ b/bbn_wave_freq_m5atomS3/KalmanForWaveAlt.h @@ -215,7 +215,7 @@ void kalman_wave_alt_init_defaults() { matrix_set_symmetric(Q, 2, 2, (matrix_data_t)0.04 * variance); matrix_set_symmetric(Q, 2, 3, (matrix_data_t)0.0); matrix_set_symmetric(Q, 2, 4, (matrix_data_t)0.0); - matrix_set_symmetric(Q, 3, 3, (matrix_data_t)100000.0 * variance); + matrix_set_symmetric(Q, 3, 3, (matrix_data_t)1000.0 * variance); matrix_set_symmetric(Q, 3, 4, (matrix_data_t)0.0); matrix_set_symmetric(Q, 4, 4, (matrix_data_t)0.0002 * variance); }