%% Extended Kalman Filter
clc
clear all

%Parameter
d = 700;                % Dämpferrate in kg/s
c = 7000;               % Federkoeffizient in kg/s^2
m = 100;                % Masse kg
T = 1/500;              % Abtastzeit
n = 5;                  % Anzahl Zustandsgrößen
C = [1 0 -1 0 0];       % Ausgangsmatrix (linear)
H = [0; 0; 0; T; 0];    % Eingangsmatrix (linear)
k_ff = 50;
beta_ff = 30;
gamma_ff = 60;