function y=fandianshifcn(u)
K=0.0025;
w=u(1);
theta=u(2);
if((theta>=0)&&(theta<pi/3))
y=[K*w;-K*w;K*w*((-theta)/(pi/6)+1)];
elseif((theta>=pi/3)&&(theta<2*pi/3))
y=[K*w;K*w*((theta-pi/3)/pi/6)-1;K*w];
elseif((theta>=2*pi/3)&&(theta<pi))
y=[K*w*((2*pi/3-theta)/(pi/6)+1);K*w;K*w];
elseif((theta>=pi)&&(theta<4*pi/3))
y=[-K*w;K*w;K*w*((theta-pi)/(pi/6)-1)];
elseif((theta>=4*pi/3)&&(theta<5*pi/3))
y=[-K*w;K*w*((4*pi/3-theta)/(pi/6)+1);K*w];
elseif((theta>=5*pi/3)&&(theta<=2*pi))
y=[K*w*((theta-5*pi/3)/(pi/6)-1);-K*w;K*w];
end
- 1
- 2
- 3
- 4
前往页