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 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63
|
% Tsup=0.8;
% t=[0:0.002:Tsup]
% f=cosh(t/Tsup)+sinh(t/Tsup)
% plot(f,'r');
clc,
clear all,
close all,
%declaration des constantes
g=9.8;
Tsup=0.8;%temps de support
z=0.8;%hauteur du centre de masse considérée constante pour un modele LIP
a=10;
b=1;
Tc=sqrt(z/g)
X0=0;
Y0=0;
pas=0.03;
sx=[0.0, 0.3, 0.3, 0.3, 0];%longueur des pas
sy=[0.2, 0.2, 0.2, 0.2, 0.2];%largeur des pas
sx(6)=0;
sy(6)=0;
%Initialisation
%Etape2:
CI1=[-0.2,0.791];
xi=-0.2;
yi=-0.2;
vxi=0.4;
vyi=0.4;
pxmp=-0.1;
pymp=-0.1;
pxprevious=-0.1;
pyprevious=-0.1;
% xi=zeros(n);
% yi=zeros(n);
% vxi=zeros(n);
% vyi=zeros(n);
n=5;
xf=zeros(1,n);
yf=zeros(1,n);
vxf=zeros(1,n);
vyf=zeros(1,n);
L=0.04;
%t=0.001:pas: ;
i=1;
for r=1:n;
for t=1:pas:1+Tsup
%selon x:
xf(1,r)=(xi-pxmp)*cosh(t/Tc)+Tc*vxi*sinh(t/Tc)+pxmp%la valeure finale de la position x du pied (ou la solution selon x)
vxf(1,r)=((xi-pxmp)/Tc)*sinh(t/Tc)+vxi*cosh(t/Tc)%la valeure finale de la vitesse selon x du pied
%selon y:
yf(1,r)=(yi-pymp)*cosh(t/Tc)+Tc*vyi*sinh(t/Tc)+pymp
vyf(1,r)=((yi-pymp)/Tc)*sinh(t/Tc)+vyi*cosh(t/Tc)
hold on,
%subplot(1,2,1),plot(vxf,vyf,'b'), grid on;
% subplot(1,2,2),
plot3d(xf,yf,z,'b'), grid on
end |
Partager