关于两个自由度间隙碰撞的程序只能通过ode45算出没有发生碰撞时两个物体位移和速度,考虑间隙大小,发生碰撞后速度和位移都会发生变化,该怎样编程,自己编了一个程序,把两位移之差满足间隙作为条件语句,然后速度发生变化,但是位移任为未发生碰撞的位移,明显错误,现向各位求教,下面我贴出我的程序,请指正(红色为有问题的部分)function dy=test_fun(t,y)
g(1)=0.02;
g(2)=0.02;
u=0.02;
% f(t)=1;
% fe=1;
dy=zeros(4,1);
% y=zeros(4,1);
dy(1)=y(3);
dy(2)=y(4);
dy(3)= -2*g(1)*y(3)-y(1)+u*2*g(2)*y(4)+u*y(2)+cos(t);% c-b*x(1)-w*x(1)*x(2);
dy(4)= -2*(1+u)*g(2)*y(4)-(1+u)*y(2)+2*g(1)*y(3)+y(1)-cos(t); % w*x(1)*x(2)-(b+m)*x(2);
end
y0=[0,0,0,0];
[t,y]=ode45('test_fun',[0,30],y0); T=30; y0=[0,0,0,0]; [t,y]=ode45('test_fun',T,y0);
T=[0:0.1:30]; y0=[0,0,0,0]; [t,y]=ode45('test_fun',T,y0); u=0.02; r=0.2; for i=1:length(T) if abs(y(i,1)-y(i,2))>=0.8 Y(i,3)=(1-u*r)./(1+u)*y(i,3)+u*(1+r)./(1+u)*y(i,4); Y(i,4)=(1+r)./(1+u)*y(i,3)+(u-r)./(1+u)*y(i,4); else Y(i,3)=y(i,3); Y(i,4)=y(i,4); end Y(i,1)=y(i,1); Y(i,2)=y(i,2); end |