ciitc.m

来自「This software gave volume MoM solution b」· M 代码 · 共 45 行

function ciitc=ciitc(xs,ys,zs,xe,ye,ze,rs,re,ps,pe,x0,y0,z0);
 
d=sqrt((xe-xs)^2+(ye-ys)^2+(ze-zs)^2);
ciitc=0;

x0=x0-xs;
y0=y0-ys;
z0=z0-zs;

ddtc=sqrt((xe-xs)^2+(ye-ys)^2+(ze-zs)^2); 
theta=acos(sqrt((xe-xs)^2+(ye-ys)^2)/sqrt((xe-xs)^2+(ye-ys)^2+(ze-zs)^2));
phi=atan2((ye-ys),(xe-xs));
if (phi<0), phi=phi+2*pi;  end;

x1=x0*cos(phi)+y0*sin(phi);
y1=x0*sin(phi)-y0*cos(phi);
z1=z0;


x0=x1;y0=y1;z0=z1;

x1=x0*cos(theta)+z0*sin(theta);
y1=y0;
z1=-x0*sin(theta)+z0*cos(theta);


x0=x1;y0=y1;z0=z1;



r=sqrt(z0^2+y0^2);
ph=acos((z0)/r)*180/pi;
rt=(1-(x0)/d)*rs+((x0)/d)*re;

if ((x0<=ddtc)&(x0>=0)), 
if (r<=rt),
   if (ph>=ps),
      if (ph<=pe),
        ciitc=1;
      end;
   end;
end;
end;