diff --git a/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino b/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino index 061c6dd..b7f91bf 100644 --- a/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino +++ b/bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino @@ -47,7 +47,7 @@ void repeatMe() { last_update = now; double y = accel.z - 1.0 /* since it includes g */; - //double y = sin(2*PI*t*0.25); // dummy test data + //double y = sin(2 * PI * state.t * 0.25); // dummy test data aranovskiy_update(¶ms, &state, y, delta_t); @@ -70,10 +70,6 @@ void repeatMe() { void setup(void) { auto cfg = M5.config(); M5.begin(cfg); - //imu6886.Init(); - //auto imu6886 = ((m5::MPU6886_Class*) &M5.Imu); - //imu6886->enableFIFO(imu6886->ODR_1kHz); - //imu6886->setAccelFsr(imu6886->AFS_2G); aranovskiy_default_params(¶ms, omega_up, k_gain); aranovskiy_init_state(&state, t_0, x1_0, theta_0, sigma_0);