ACwing FC firmware
STM32WB55: attitude IEKF, altitude Kalman filter, flight core, protocol v2
Loading...
Searching...
No Matches
accwin.c File Reference
#include "accwin.h"
#include "so3.h"
#include <string.h>
Include dependency graph for accwin.c:

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

 

Function Documentation

◆ accwin_reset()

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().

Here is the caller graph for this function:

◆ accwin_add()

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().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ accwin_rotate()

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().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ accwin_mean()

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().

Here is the call graph for this function:
Here is the caller graph for this function: