% _____________________________________________
% Vorlesung Biomechanik: Integration mit MATLAB 
% Berechnung KSP Bahn aus Bodenreaktionskräften
% _____________________________________________
% Andre Seyfarth, Oktober 2012

clear all
clc

%% (1) Kraftdaten einlesen
load data %KISTLER-Kraftdaten vom Hüpfen


%% (2) Zeitfenster auswählen
sel = 4001:8000;
t  = data(sel,1)'-4;
Fy = data(sel,4)';


%% (3) Kraftdaten anzeigen
fs = 14; % font size
subplot(121)
set(gca, 'fontsize', fs)
plot(t, Fy, 'linewidth', 2) 
xlabel('time [s]')
ylabel('force Fy [N]')
shg

%% (4) Beschleunigung in Y berechnen
g  = 9.81;          %Gravitationsbeschleunigung
dt = 0.001;         %Messfrequenz
Fg = mean (Fy)      %Gewichtskraft bestimmen
m  = Fg / 9.81;     %Körpermasse bestimmen
ay = Fy/m - g;      %KSP Beschleunigung bestimmen


%% (5) Geschwindigkeit und Position KSP berechnen
vy_i = 0;
y_i  = 1;

for i = 1:length(ay)
  vy_i = vy_i + ay(i)*dt;
  y_i  = y_i + vy_i*dt;
  vy(i) = vy_i;
  y(i)  = y_i;
end

%% (6) KSP Verlauf anzeigen
subplot(122)
set(gca, 'fontsize', fs)
plot(t,ay,t,vy,t,y*10, 'linewidth', 2)
legend ('ay','vy','y')
xlabel('time [s]')
ylabel('acc [m/s^2]   /   vel [m/s]   /   pos [m]')
shg