direction.m

在matlab环境下

function [x,v]=direction(x1,x2)
v1=p2(x1'); v2=p2(x2');
x3=x2+0.01*(x2-x1);
v3=p2(x3');
if v3>v2
   x=x3;
   v=v3;
else 
   x=x2;
   v=v2;
end