Matlab圆弧插补程序+郑国安.docx

Matlab圆弧插补程序+郑国安.docx

《Matlab圆弧插补程序+郑国安.docx》由会员分享，可在线阅读，更多相关《Matlab圆弧插补程序+郑国安.docx（5页珍藏版）》请在冰豆网上搜索。

Matlab圆弧插补程序+郑国安

Matlab圆弧插补程序+郑国安

X0=input（'请输入起点横轴坐标X\nX0='）;

Y0=input（'请输入起点纵轴坐标Y\nY0='）;

Xe=input（'请输入终点横轴坐标X\nXe='）;

Ye=input（'请输入终点纵轴坐标Y\nYe='）;

R=input（'请输入圆弧半径\nR='）;

NorF=input（'请选择圆心（1代表靠近原点2代表远离原点）:

\n'）;

SorN=input（'请选择补走向（1代表顺时针/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

%画基准圆

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）^2>h*h/2|（step==0&mark==0））

if（（Xm-x0）>0&（Ym-y0）>=0）XOY=1;%判断动点所在象限

end

if（（Xm-x0）<=0&（Ym-y0）>0）XOY=2;

end

if（（Xm-x0）<0&（Ym-y0）<=0）XOY=3;

end

if（（Xm-x0）>=0&（Ym-y0）<0）XOY=4;

end

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）

x1=[Xm,Xm+h];

y1=[Ym,Ym];

else

x1=[Xm,Xm];

y1=[Ym,Ym+h];

end

else

if（Fm>0）

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];

y1=[Ym,Ym];

end

else

if（Fm>0）

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（Fm>0）

x1=[Xm,Xm];

y1=[Ym,Ym+h];

else

x1=[Xm,Xm+h];

y1=[Ym,Ym];

end

end

end

step=step+1;

plot（x1,y1,'r-'）;%由此点和前一点坐标组成的2个向量画直线

Xm=x1

（2）;%保存此点坐标供下次作图和比较时使用

Ym=y1

（2）;

Fm=（Xm-x0）^2+（Ym-y0）^2-R^2;

holdon;

text（（x1

（1）+x1

（2））/2,（y1

（1）+y1

（2））/2,[num2str（step）]）

pause（0.5）;%延时程序形参为每走一步所用时间

end

xlabel（'X'）

ylabel（'Y'）

title（['四象限圆弧插补']）

holdoff;