![]() |
ACwing FC firmware
STM32WB55: attitude IEKF, altitude Kalman filter, flight core, protocol v2
|
Go to the source code of this file.
Functions | |
| void | accwin_reset (accwin_t *w) |
| void | accwin_add (accwin_t *w, const float acc[3]) |
| sample in the current body | |
| void | accwin_rotate (accwin_t *w, const float E[9]) |
| after every propagation | |
| int | accwin_mean (const accwin_t *w, float out[3]) |
| in the current body, 0 = OK | |
| void accwin_reset | ( | accwin_t * | w | ) |
Definition at line 8 of file accwin.c.
References accwin_t::D.
Referenced by est_init(), on_acc_window(), and on_mag().
| void accwin_add | ( | accwin_t * | w, |
| const float | acc[3] | ||
| ) |
sample in the current body
Definition at line 14 of file accwin.c.
References accwin_t::D, mat3_vec(), accwin_t::n, and accwin_t::sum.
Referenced by est_process().
| void accwin_rotate | ( | accwin_t * | w, |
| const float | E[9] | ||
| ) |
after every propagation
Definition at line 22 of file accwin.c.
References accwin_t::D, and mat3_mul().
Referenced by on_step().
| int accwin_mean | ( | const accwin_t * | w, |
| float | out[3] | ||
| ) |
in the current body, 0 = OK
Definition at line 29 of file accwin.c.
References accwin_t::D, mat3t_vec(), accwin_t::n, and accwin_t::sum.
Referenced by on_acc_window().