Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
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()

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

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

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

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.

References xi.

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

void UKF_Wind_Estimator_step ( void )

Definition at line 1088 of file UKF_Wind_Estimator.c.

References h(), K, lambda, mrdivide(), p, qr(), qr_e(), RungeKutta(), ukf_DW, ukf_init, ukf_params, ukf_U, and ukf_Y.

Referenced by wind_estimator_step().

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

◆ xgeqrf()

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

Definition at line 412 of file UKF_Wind_Estimator.c.

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

Referenced by qr().

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

◆ xgeqrf_f()

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

Definition at line 83 of file UKF_Wind_Estimator.c.

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

Referenced by qr_e().

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

◆ xnrm2()

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

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