load('sprong10.mat');
% practicum 1 opdracht 1
joints = yztodat(y,z);
com = [ ];
stick2(joints, fg, ay, com, fs)
% practicum 0/1 opdracht 2b
relatief = [0.475 0.302 0.323 1.731 0.504 0.313 0.468];
Rgyr = relatief.*linkleng;
massa = [2.1879 7.2675 16.065 6.0588 36.0927 4.9725 3.8556];
Rgyr2 = Rgyr.^2;
Traagheidsmoment = Rgyr2.*massa;
vecMTP5 = joints(:,1:2);
vecENKEL = joints(:,3:4);
dzpvoet = (vecMTP5 - vecENKEL)*0.500+vecENKEL;
vecKNIE = joints(:,5:6);
dzpob = (vecENKEL - vecKNIE)*0.434+vecKNIE;
vecHEUP = joints(:,7:8);
dzpbb = (vecKNIE - vecHEUP)*0.433+vecHEUP;
vecL5S1 = joints(:,9:10);
dzpbek = (vecHEUP - vecL5S1)*0.634+vecL5S1;
vecSCHOUDER = joints(:, 11:12);
dzpromphoofd = (vecL5S1-vecSCHOUDER)*0.306+vecSCHOUDER;
vecELLEBOOG = joints(:, 13:14);
dzpba = (vecSCHOUDER-vecELLEBOOG)*0.564+vecELLEBOOG;
vecPOLS = joints(:, 15:16);
dzpoa = (vecELLEBOOG-vecPOLS)*0.318+vecPOLS;
% practicum 1: opdracht 2b
% de onbekenden zijn alpha en de versnelling van het dzp
vectorvoet = vecMTP5-vecENKEL;
vectorob = vecENKEL-vecKNIE;
vectorbb = vecKNIE - vecHEUP;
vectorbek = vecHEUP - vecL5S1;
vectorromp = vecL5S1 - vecSCHOUDER;
vectorba = vecSCHOUDER - vecELLEBOOG;
vectoroa = vecELLEBOOG - vecPOLS;
hoekvoet = angle2d(vectorvoet);
hoekob = angle2d(vectorob);
hoekbb = angle2d(vectorbb);
hoekbek = angle2d(vectorbek);
hoekromp = angle2d(vectorromp);
hoekba = angle2d(vectorba);
hoekoa = angle2d(vectoroa);
, omegavoet = afgcol(hoekvoet, fs);
omegaob = afgcol(hoekob, fs);
omegabb = afgcol(hoekbb, fs);
omegabek = afgcol(hoekbek, fs);
omegaromp = afgcol(hoekromp, fs);
omegaba = afgcol(hoekba, fs);
omegaoa = afgcol(hoekoa, fs);
alphavoet = afgcol(omegavoet, fs);
alphaob = afgcol(omegaob, fs);
alphabb = afgcol(omegabb, fs);
alphabek = afgcol(omegabek, fs);
alpharomp = afgcol(omegaromp, fs);
alphaba = afgcol(omegaba, fs);
alphaoa = afgcol(omegaoa, fs);
v_voet = afgcol(dzpvoet, fs);
v_ob = afgcol(dzpob, fs);
v_bb = afgcol(dzpbb, fs);
v_bek = afgcol(dzpbek, fs);
v_romphoofd = afgcol(dzpromphoofd, fs);
v_ba = afgcol(dzpba, fs);
v_oa = afgcol(dzpoa, fs);
a_voet = afgcol(v_voet, fs);
a_ob = afgcol(v_ob, fs);
a_bb = afgcol(v_bb, fs);
a_bek = afgcol(v_bek, fs);
a_romphoofd = afgcol(v_romphoofd, fs);
a_ba = afgcol(v_ba, fs);
a_oa = afgcol(v_oa, fs);
% practicum 1 opdracht 2F
massavoet = ppmass*0.0286;
g = [0 -9.81];
Fev = (massavoet*a_voet) - (fg) - (massavoet*g);
Feob = -Fev;
massaob = ppmass*0.0950;
Fkob = (massaob*a_ob) - Feob - (massaob*g);
Fkbb = -Fkob;
massabb = ppmass*0.2100;
Fheupbb = (massabb*a_bb) - Fkbb - (massabb*g);
Fheupbek = -Fheupbb;
massabek = ppmass*0.0792;
FL5S1bek = (massabek*a_bek) - Fheupbek - (massabek*g);
FL5S1romp = -FL5S1bek;
% practicum 1 opdracht 1
joints = yztodat(y,z);
com = [ ];
stick2(joints, fg, ay, com, fs)
% practicum 0/1 opdracht 2b
relatief = [0.475 0.302 0.323 1.731 0.504 0.313 0.468];
Rgyr = relatief.*linkleng;
massa = [2.1879 7.2675 16.065 6.0588 36.0927 4.9725 3.8556];
Rgyr2 = Rgyr.^2;
Traagheidsmoment = Rgyr2.*massa;
vecMTP5 = joints(:,1:2);
vecENKEL = joints(:,3:4);
dzpvoet = (vecMTP5 - vecENKEL)*0.500+vecENKEL;
vecKNIE = joints(:,5:6);
dzpob = (vecENKEL - vecKNIE)*0.434+vecKNIE;
vecHEUP = joints(:,7:8);
dzpbb = (vecKNIE - vecHEUP)*0.433+vecHEUP;
vecL5S1 = joints(:,9:10);
dzpbek = (vecHEUP - vecL5S1)*0.634+vecL5S1;
vecSCHOUDER = joints(:, 11:12);
dzpromphoofd = (vecL5S1-vecSCHOUDER)*0.306+vecSCHOUDER;
vecELLEBOOG = joints(:, 13:14);
dzpba = (vecSCHOUDER-vecELLEBOOG)*0.564+vecELLEBOOG;
vecPOLS = joints(:, 15:16);
dzpoa = (vecELLEBOOG-vecPOLS)*0.318+vecPOLS;
% practicum 1: opdracht 2b
% de onbekenden zijn alpha en de versnelling van het dzp
vectorvoet = vecMTP5-vecENKEL;
vectorob = vecENKEL-vecKNIE;
vectorbb = vecKNIE - vecHEUP;
vectorbek = vecHEUP - vecL5S1;
vectorromp = vecL5S1 - vecSCHOUDER;
vectorba = vecSCHOUDER - vecELLEBOOG;
vectoroa = vecELLEBOOG - vecPOLS;
hoekvoet = angle2d(vectorvoet);
hoekob = angle2d(vectorob);
hoekbb = angle2d(vectorbb);
hoekbek = angle2d(vectorbek);
hoekromp = angle2d(vectorromp);
hoekba = angle2d(vectorba);
hoekoa = angle2d(vectoroa);
, omegavoet = afgcol(hoekvoet, fs);
omegaob = afgcol(hoekob, fs);
omegabb = afgcol(hoekbb, fs);
omegabek = afgcol(hoekbek, fs);
omegaromp = afgcol(hoekromp, fs);
omegaba = afgcol(hoekba, fs);
omegaoa = afgcol(hoekoa, fs);
alphavoet = afgcol(omegavoet, fs);
alphaob = afgcol(omegaob, fs);
alphabb = afgcol(omegabb, fs);
alphabek = afgcol(omegabek, fs);
alpharomp = afgcol(omegaromp, fs);
alphaba = afgcol(omegaba, fs);
alphaoa = afgcol(omegaoa, fs);
v_voet = afgcol(dzpvoet, fs);
v_ob = afgcol(dzpob, fs);
v_bb = afgcol(dzpbb, fs);
v_bek = afgcol(dzpbek, fs);
v_romphoofd = afgcol(dzpromphoofd, fs);
v_ba = afgcol(dzpba, fs);
v_oa = afgcol(dzpoa, fs);
a_voet = afgcol(v_voet, fs);
a_ob = afgcol(v_ob, fs);
a_bb = afgcol(v_bb, fs);
a_bek = afgcol(v_bek, fs);
a_romphoofd = afgcol(v_romphoofd, fs);
a_ba = afgcol(v_ba, fs);
a_oa = afgcol(v_oa, fs);
% practicum 1 opdracht 2F
massavoet = ppmass*0.0286;
g = [0 -9.81];
Fev = (massavoet*a_voet) - (fg) - (massavoet*g);
Feob = -Fev;
massaob = ppmass*0.0950;
Fkob = (massaob*a_ob) - Feob - (massaob*g);
Fkbb = -Fkob;
massabb = ppmass*0.2100;
Fheupbb = (massabb*a_bb) - Fkbb - (massabb*g);
Fheupbek = -Fheupbb;
massabek = ppmass*0.0792;
FL5S1bek = (massabek*a_bek) - Fheupbek - (massabek*g);
FL5S1romp = -FL5S1bek;