function ff=www(t,x)
b=1;
g=9800;
E=0.12;
f=0.12;
a=0.5;
q=0.16;
f0=25;
u=0.136/q;
w=2;
e=sqrt(x(1)^2+x(2)^2);
G=g/((2*pi*f0)^2*q);
dX=x(3);
dY=x(4);
dZ=-2*E*x(3)-x(1)-a*(x(1)^2+x(2)^2)*x(1)-b*(1-1/e)*(x(1)-f*x(2))+u*w^2*cos(w*x(5));
dP=-2*E*x(4)-x(2)-a*(x(1)^2+x(2)^2)*x(2)-b*(1-1/e)*(f*x(1)+x(2))+u*w^2*sin(w*x(5))-G;
dO=1;
J=[0,0,1,0,0;
0,0,0,1,0;
-1-(2*a*x(1)^2+a*e^2)-b*(1-1/e),-2*a*x(1)*x(2)+b*f*(1-1/e),-2*E,0,-u*w^3*sin(w*x(5));
-2*a*x(1)*x(2)-b*f*(1-1/e),-1-3*a*x(2)^2-b*(1-1/e),0,-2*E,u*w^3*cos(w*x(5));
0,0,0,0,0];
Q=[x(6),x(11),x(16),x(21),x(26);
x(7),x(12),x(17),x(22),x(27);
x(8),x(13),x(18),x(23),x(28);
x(9),x(14),x(19),x(24),x(29);
x(10),x(15),x(20),x(25),x(30)];
F=J*Q;
ff=[dX;dY;dZ;dP;dO;F(:)]; |