Paparazzi UAS  v5.18.0_stable
Paparazzi is a free software Unmanned Aircraft System.
UKF_Wind_Estimator.c File Reference
+ Include dependency graph for UKF_Wind_Estimator.c:

Go to the source code of this file.

Functions

static real32_T xnrm2_f (int32_T n, const real32_T x[147], int32_T ix0)
 
static void xgeqrf_f (real32_T A[147], real32_T tau[7])
 
static void qr_e (const real32_T A[147], real32_T Q[147], real32_T R[49])
 
static real32_T xnrm2 (int32_T n, const real32_T x[120], int32_T ix0)
 
static void xgeqrf (real32_T A[120], real32_T tau[6])
 
static void qr (const real32_T A[120], real32_T Q[120], real32_T R[36])
 
static void mrdivide (real32_T A[42], const real32_T B_0[36])
 
static void h (const real32_T x[7], const real32_T q[4], real32_T y[6])
 
static void RungeKutta (const real32_T x[7], real32_T dt, const real32_T u[6], real32_T xi[7])
 
void UKF_Wind_Estimator_step (void)
 
void UKF_Wind_Estimator_initialize (void)
 

Variables

ukf_init_type ukf_init
 
ukf_params_type ukf_params
 
DW ukf_DW
 
ExtU ukf_U
 
ExtY ukf_Y
 

Function Documentation

◆ h()

◆ mrdivide()

static void mrdivide ( real32_T  A[42],
const real32_T  B_0[36] 
)
static

Definition at line 706 of file UKF_Wind_Estimator.c.

References A, and s.

Referenced by UKF_Wind_Estimator_step().

+ Here is the caller graph for this function:

◆ qr()

static void qr ( const real32_T  A[120],
real32_T  Q[120],
real32_T  R[36] 
)
static

Definition at line 576 of file UKF_Wind_Estimator.c.

References A, c(), and xgeqrf().

Referenced by UKF_Wind_Estimator_step().

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

◆ qr_e()

static void qr_e ( const real32_T  A[147],
real32_T  Q[147],
real32_T  R[49] 
)
static

Definition at line 247 of file UKF_Wind_Estimator.c.

References A, c(), and xgeqrf_f().

Referenced by UKF_Wind_Estimator_step().

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

◆ RungeKutta()

static void RungeKutta ( const real32_T  x[7],
real32_T  dt,
const real32_T  u[6],
real32_T  xi[7] 
)
static

Definition at line 917 of file UKF_Wind_Estimator.c.

Referenced by UKF_Wind_Estimator_step().

+ Here is the caller graph for this function:

◆ UKF_Wind_Estimator_initialize()

void UKF_Wind_Estimator_initialize ( void  )

Definition at line 2098 of file UKF_Wind_Estimator.c.

Referenced by init_calculator().

+ Here is the caller graph for this function:

◆ UKF_Wind_Estimator_step()

◆ xgeqrf()

static void xgeqrf ( real32_T  A[120],
real32_T  tau[6] 
)
static

Definition at line 412 of file UKF_Wind_Estimator.c.

References A, E, f, and xnrm2().

Referenced by qr().

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

◆ xgeqrf_f()

static void xgeqrf_f ( real32_T  A[147],
real32_T  tau[7] 
)
static

Definition at line 83 of file UKF_Wind_Estimator.c.

References A, E, f, and xnrm2_f().

Referenced by qr_e().

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

◆ xnrm2()

static real32_T xnrm2 ( int32_T  n,
const real32_T  x[120],
int32_T  ix0 
)
static

Definition at line 377 of file UKF_Wind_Estimator.c.

References scale.

Referenced by xgeqrf().

+ Here is the caller graph for this function:

◆ xnrm2_f()

static real32_T xnrm2_f ( int32_T  n,
const real32_T  x[147],
int32_T  ix0 
)
static

Definition at line 48 of file UKF_Wind_Estimator.c.

References scale.

Referenced by xgeqrf_f().

+ Here is the caller graph for this function:

Variable Documentation

◆ ukf_DW

DW ukf_DW

Definition at line 27 of file UKF_Wind_Estimator.c.

Referenced by init_calculator(), and UKF_Wind_Estimator_step().

◆ ukf_init

◆ ukf_params

◆ ukf_U

◆ ukf_Y

ExtY ukf_Y