N4 Flight Software N4
Flight software used for the N4 flight computers
Loading...
Searching...
No Matches
kalman_filter.h File Reference
#include <Arduino.h>
#include <BasicLinearAlgebra.h>
#include "defs.h"

Go to the source code of this file.

Functions

void init_kalman_matrices ()

Variables

float estimated_altitude
float error_covariance_bmp
float process_variance_bmp
float measurement_variance_bmp
float kalman_gain_bmp
float altitude_kalman
float velocity_vertical_kalman
BLA::Matrix< 2, 2 > F
BLA::Matrix< 2, 2 > P
BLA::Matrix< 2, 2 > Q
BLA::Matrix< 2, 2 > I
BLA::Matrix< 2, 1 > G
BLA::Matrix< 2, 1 > S
BLA::Matrix< 2, 1 > K
BLA::Matrix< 1, 2 > H
BLA::Matrix< 1, 1 > R
BLA::Matrix< 1, 1 > L
BLA::Matrix< 1, 1 > inv_L
BLA::Matrix< 1, 1 > Acc
BLA::Matrix< 1, 1 > M
float x_acc
float x_acc_g
float x_acc_offset
float roll
float pitch
float bmp_altitude

Detailed Description

Implement Kalman Filter

Function Documentation

◆ init_kalman_matrices()

void init_kalman_matrices ( )

Kalman filter matrices