10 lines
186 B
Matlab
10 lines
186 B
Matlab
function [raf,jl]=pmzbfs(x1,y1,x2,y2)
|
|
detx=x2-x1;dety=y2-y1;
|
|
faw1=atan(dety/detx);
|
|
j1=sqrt(detx*detx+dety*dety);
|
|
if detx<0
|
|
raf=faw1+pi;
|
|
end
|
|
if (detx>0)*(det<0)
|
|
raf=faw1+2*pi;
|
|
end |