1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44
| tf=-1;
while tf<0
tf=input('valeur de tf=');
end;
A=[tf^5 tf^4 tf^3; 5*tf^4 4*tf^3 3*tf^2; 20*tf^3 12*tf^2 6*tf];
teta10=-0,33;
teta1tf=0,75;
while (teta10>(pi/2)) , (teta1tf<(-pi/2))
teta10=input('valeur de teta1(0)=');
teta1tf=input('valeur de teta1(tf)=');
end;
teta20=0,768;
teta2tf=2,635;
while (teta20>pi) , (teta2tf<-pi)
teta20=input('valeur de teta2(0)=');
teta2tf=input('valeur de teta2(tf)=');
end;
B=[teta1tf-teta10; 0; 0];
S=inv(A);
%SS est la matrice des coefficient ai
SS=S*B;
A1=[tf^5 tf^4 tf^3; 5*tf^4 4*tf^3 3*tf^2; 20*tf^3 12*tf^2 6*tf];
B1=[teta2tf-teta20; 0; 0];
S1=inv(A1);
%SS1 est la matrice des coefficient bi
SS1=S1*B1;
a1=SS(1,1);
a2=SS(2,1);
a3=SS(3,1);
b1=SS1(1,1);
b2=SS1(2,1);
b3=SS1(3,1);
%declaration de teta1 et teta2 dans la forme matricielle
teta1=[];
teta2=[];
for (t=0:0.05:tf),
teta11=teta10+a1*t^5+a2*t^4+a3*t^3;
teta21=teta20+b1*t^5+b2*t^4+b3*t^3;
teta1=[teta1 teta11];
teta2=[teta2 teta21];
end;
x1=1.2192*cos(teta1)+0.9144*cos(teta1+teta2);
x2=1.2192*sin(teta1)+0.9144*sin(teta1+teta2);
plot(x1,x2,'r*'); |
Partager