Matlab圆弧插补程序郑国安.docxVIP

第1页

Matlab圆弧插补程序+郑国安

X0=input(请输入起点横轴坐标X\nX0=);

Y0=input(请输入起点纵轴坐标Y\nY0=);

Xe=input(请输入终点横轴坐标X\nXe=);

Ye=input(请输入终点纵轴坐标Y\nYe=);

R=input(请输入圆弧半径\nR=);NorF=input(请选择圆心(1代表挨近原点点):\n);

SorN=input(请选择补走向(1代表顺时针/2

);

2代表远离原

代表逆时针):\n

h=input(请输入步长\nh=);

if((Xe==X0)(Ye==Y0))

x01=0;y01=0;

x02=2*Xe;y02=2*Ye;

R=sqrt(Xe^2+Ye^2);

mark=0;

else

mark=1;

k1=(Ye-Y0)/(Xe-X0);

k2=-1/k1;

Xz=(X0+Xe)/2;Yz=(Y0+Ye)/2;%两点中点坐标

L1=sqrt((X0-Xe)^2+(Y0-Ye)^2)/2;%两点之间距离的

一半

L2=sqrt(R^2-L1^2);

beta=atan(k2);

%挨近x01=Xz-L2*cos(beta);y01=Yz-L2*sin(beta);原点

%挨近

%远离x02=Xz+L2*cos(beta);y02=Yz+L2*sin(beta);原点

%远离

end

if(NorF==1)%判断圆心位置

if((x01^2+y01^2-x02^2-y02^2)=0)

x0=x01;y0=y01;

else

x0=x02;y0=y02;

end

else

if((x01^2+y01^2-x02^2-y02^2)=0)

x0=x02;y0=y02;

else

x0=x01;y0=y01;

end

end

%画基准圆

第2页

alpha=0:pi/20:2*pi;

xx=R*cos(alpha)+x0;

yy=R*sin(alpha)+y0;

plot(xx,yy,g:);

holdon;

axisequal;

Xm=X0;

Ym=Y0;

%NXY=(abs(Xe-X0)+abs(Ye-Y0))/h;

step=0;

Fm=0;

while

((Xm-Xe)^2+(Ym-Ye)^2h*h/2|(step==0mark==0))

if((Xm-x0)0(Ym-y0)=0)XOY=1;%判断动

点所在象限

end

if((Xm-x0)=0(Ym-y0)0)

end

if((Xm-x0)0(Ym-y0)=0)

end

if((Xm-x0)=0(Ym-y0)0)

XOY=2;

XOY=3;

XOY=4;

end

第3页

switchXOY

case1

if(SorN==1)

if(Fm=0)

x1=[Xm,Xm];

y1=[Ym,Ym-h];

else

x1=[Xm,Xm+h];

y1=[Ym,Ym];

end

else

if(Fm=0)

x1=[Xm,Xm];

y1=[Ym,Ym+h];

else

x1=[Xm,Xm-h];

y1=[Ym,Ym];

end

end

case2

if(SorN==1)

if(Fm=0)

第4页

x1=[Xm,Xm+h];

y1=[Ym,Ym];

else

x1=[Xm,Xm];

y1=[Ym,Ym+h];

end

else

if(Fm0)

x1=[Xm,Xm];

y1=[Ym,Ym-h];

else

x1=[Xm,Xm-h];

y1=[Ym,Ym];

end

end

case3

if(SorN==1)

if(Fm=0)

x1=[Xm,Xm];

y1=[Ym,Ym+h];

else

x1=[Xm,Xm-h];

第5页

y1=[Ym,Ym];

end

else

if(Fm0)

x1=[Xm,Xm+h];

y1=[Ym,Ym];

else

x1=[Xm,Xm];

y1=[Ym,Ym-h];

end

end

case4

if(SorN==1)

if(Fm=0)

x1=[Xm,Xm-h];

y1=[Ym,Ym];

else

x1=[Xm,Xm];

y1=[Ym,Ym-h];

end

else

if(Fm0)

第6页

x1=[Xm,Xm];

y1=[Ym,Ym+h];

else

x1=[Xm,Xm+h];

y1=[Ym,Ym];

end

end

end

step=step+1;

pl