xiedistance.m

目标运动模型

function y=xiedistance(t,D,b,Km)  
Vm=400;
Kw=300;
Vw=20;
y=-Vm*cos(b-Km+pi)-Vw*cos(b-Kw);