load('outputsprong8.mat');
% stickfiguur
joints = yztodat(y,z);
com = [ ];
stick2(joints, fg, ay, com, fs)
% METHODE 1
% energie segment voet
Epot0_v = -massavoet*(g(2)*dzpvoet(1,2));
Epot_v = -(massavoet*(g(2)*dzpvoet(:, 2))) - Epot0_v;
Ekint_v = 0.5.*massavoet.*(v_voet(:, 1).^2 + v_voet(:, 2).^2);
Ekinr_v = 0.5*Ivoet*(omegavoet.^2);
E_voet = Epot_v + Ekint_v + Ekinr_v;
% energie segment onderbeen
Epot0_ob = -massaob*(g(2)*dzpob(1,2));
Epot_ob = -(massaob*(g(2)*dzpob(:, 2))) - Epot0_ob;
Ekint_ob = 0.5.*massaob.*(v_ob(:, 1).^2 + v_ob(:, 2).^2);
Ekinr_ob = 0.5*Iob*(omegaob.^2);
E_onderbeen = Epot_ob + Ekint_ob + Ekinr_ob;
% energie segment bovenbeen
Epot0_bb = -massabb*(g(2)*dzpbb(1,2));
Epot_bb = -(massabb*(g(2)*dzpbb(:, 2))) - Epot0_bb;
Ekint_bb = 0.5.*massabb.*(v_bb(:, 1).^2 + v_bb(:, 2).^2);
Ekinr_bb = 0.5*Ibb*(omegabb.^2);
E_bovenbeen = Epot_bb + Ekint_bb + Ekinr_bb;
% energie segment bekken
Epot0_bek = -massabek*(g(2)*dzpbek(1,2));
Epot_bek = -(massabek*(g(2)*dzpbek(:, 2))) - Epot0_bek;
Ekint_bek = 0.5.*massabek.*(v_bek(:, 1).^2 + v_bek(:, 2).^2);
Ekinr_bek = 0.5*Ibek*(omegabek.^2);
E_bekken = Epot_bek + Ekint_bek + Ekinr_bek;
% energie segment romphoofd
Epot0_romphoofd = -massaromphoofd*(g(2)*dzpromphoofd(1,2));
Epot_romphoofd = -(massaromphoofd*(g(2)*dzpromphoofd(:, 2))) -
Epot0_romphoofd;
Ekint_romphoofd = 0.5.*massaromphoofd.*(v_romphoofd(:, 1).^2 +
v_romphoofd(:, 2).^2);
Ekinr_romphoofd = 0.5*Iromp*(omegaromp.^2);
E_romphoofd = Epot_romphoofd + Ekint_romphoofd + Ekinr_romphoofd;
% energie segment bovenarm
Epot0_ba = -massaba*(g(2)*dzpba(1,2));
Epot_ba = -(massaba*(g(2)*dzpba(:, 2))) - Epot0_ba;
, Ekint_ba = 0.5.*massaba.*(v_ba(:, 1).^2 + v_ba(:, 2).^2);
Ekinr_ba = 0.5*Iba*(omegaba.^2);
E_bovenarm = Epot_ba + Ekint_ba + Ekinr_ba;
% energie segment onderarm-hand
Epot0_oah = -massaoah*(g(2)*dzpoa(1,2));
Epot_oah = -(massaoah*(g(2)*dzpoa(:, 2))) - Epot0_oah;
Ekint_oah = 0.5.*massaoah.*(v_oa(:, 1).^2 + v_oa(:, 2).^2);
Ekinr_oah = 0.5*Ioa*(omegaoa.^2);
E_onderarmhand = Epot_oah + Ekint_oah + Ekinr_oah;
A_tot_methode1 = E_voet + E_onderbeen + E_bovenbeen + E_bekken +
E_romphoofd + E_bovenarm + E_onderarmhand;
P_tot_methode1 = afgcol(A_tot_methode1, fs);
Epot_tot = Epot_v + Epot_ob + Epot_bb + Epot_bek + Epot_romphoofd
+ Epot_ba + Epot_oah;
Ekint_tot = Ekint_v + Ekint_ob + Ekint_bb + Ekint_bek +
Ekint_romphoofd + Ekint_ba + Ekint_oah;
Ekinr_tot = Ekinr_v + Ekinr_ob + Ekinr_bb + Ekinr_bek +
Ekinr_romphoofd + Ekinr_ba + Ekinr_oah;
% METHODE 2
% krachten
v_ay = afgcol(ay, fs);
P_M_methode2 = Meob.*(omegaob - omegavoet)+ Mkbb.*(omegabb -
omegaob)+ Mheupbekken.*(omegabek-omegabb) +
ML5S1romp.*(omegaromp-omegabek) + Msba.*(omegaba-omegaromp)
+Meoa.*(omegaoa-omegaba);
A_tot_methode2 = cumsum(P_M_methode2)/fs;
P_enkel = Meob.*(omegaob - omegavoet);
P_knie = Mkbb.*(omegabb - omegaob);
P_heup = Mheupbekken.*(omegabek-omegabb);
P_L5S1 = ML5S1romp.*(omegaromp-omegabek);
P_schouder = Msba.*(omegaba-omegaromp);
P_elleboog = Meoa.*(omegaoa-omegaba);
A_enkel = cumsum(P_enkel)/fs;
A_knie = cumsum(P_knie)/fs;
A_heup = cumsum(P_heup)/fs;
A_L5S1 = cumsum(P_L5S1)/fs;
A_schouder = cumsum(P_schouder)/fs;
A_elleboog = cumsum(P_elleboog)/fs;
% METHODE 3
