碰撞matlab编程求助

张张

各位前辈，关于两个自由度间隙碰撞的程序只能通过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

张张

没人吗？

怪咖先生

代码给点注释吧 外行看不懂啊