Skip to content

Commit

Permalink
Update bbn_wave_freq_m5atomS3.ino
Browse files Browse the repository at this point in the history
  • Loading branch information
mgrouch authored Sep 11, 2024
1 parent a153172 commit afffabe
Showing 1 changed file with 2 additions and 3 deletions.
5 changes: 2 additions & 3 deletions bbn_wave_freq_m5atomS3/bbn_wave_freq_m5atomS3.ino
Original file line number Diff line number Diff line change
Expand Up @@ -353,13 +353,12 @@ void setup(void) {
Even 2cm bias in heave is too much to affect frequency a lot
*/
double omega_init = 0.04 * (2 * PI); // init frequency Hz * 2 * PI (start converging from omega_init/2)
double k_gain = 200.0; // Aranovskiy gain. Higher value will give faster convergence, but too high will overflow float
double t_0 = 0.0;
double k_gain = 200.0; // Aranovskiy gain. Higher value will give faster convergence, but too high will potentially overflow decimal
double x1_0 = 0.0;
double theta_0 = - (omega_init * omega_init / 4.0);
double sigma_0 = theta_0;
aranovskiy_default_params(&params, omega_init, k_gain);
aranovskiy_init_state(&state, t_0, x1_0, theta_0, sigma_0);
aranovskiy_init_state(&state, x1_0, theta_0, sigma_0);

{
double process_noise_covariance = 0.1;
Expand Down

0 comments on commit afffabe

Please sign in to comment.