Browse Source

Tuned filter gains, still suboptimal, but improved

sbg
Lorenz Meier 13 years ago
parent
commit
c9a453c340
  1. 12
      apps/px4/attitude_estimator_bm/attitude_bm.c

12
apps/px4/attitude_estimator_bm/attitude_bm.c

@ -150,15 +150,15 @@ void attitude_blackmagic_init(void) @@ -150,15 +150,15 @@ void attitude_blackmagic_init(void)
0.0007f , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0,
0 , 0.0007f , 0 , 0 , 0 , 0 , 0 , 0 , 0,
0 , 0 , 0.0007f , 0 , 0 , 0 , 0 , 0 , 0,
0 , 0 , 0 , 0.01f, 0 , 0 , 0 , 0 , 0,
0 , 0 , 0 , 0 , 0.01f, 0 , 0 , 0 , 0,
0 , 0 , 0 , 0 , 0 , 0.01f, 0 , 0 , 0,
0 , 0 , 0 , 0.015f, 0 , 0 , 0 , 0 , 0,
0 , 0 , 0 , 0 , 0.015f, 0 , 0 , 0 , 0,
0 , 0 , 0 , 0 , 0 , 0.015f, 0 , 0 , 0,
0.0000f , +0.00002f, 0 , 0 , 0, 0, 0, 0 , 0,
-0.00002f, 0 , 0 , 0 , 0, 0, 0, 0, 0,
0, 0 , 0 , 0, 0, 0, 0, 0, 0,
0 , 0 , 0 , 0 , 0 , 0 , 0.4f , 0 , 0,
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0.4f , 0,
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0.4f
0 , 0 , 0 , 0 , 0 , 0 , 0.7f , 0 , 0,
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0.7f , 0,
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0.7f
};
//offset update only correct if not upside down.

Loading…
Cancel
Save