Matlab圆弧插补程序郑国安

1、第 第8页MatlabX0=input(请输入起点横轴坐标Xn X0 = ); Y0=input(请输入起点纵轴坐标Yn Y0 = ); Xe=input(请输入终点横轴坐标Xn Xe =); Ye=input(请输入终点纵轴坐标 Yn Ye = ); R=input(n R = );NorF=input(请选择圆心 (1 代表靠近原点2 代表远离原点):n);SorN=input(请选择补走向(1 代表顺时针/2 代表逆时针):n );h=input(请输入步长n h = ); if(Xe=X0)&(Ye=Y0)x01 = 0;y01 = 0;x02 = 2*Xe;y02 = R = sqr

2、t(Xe2+Ye2); mark = 0;elsemark = 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(R2-L12); beta = atan(k2);x01 = Xz-L2*cos(beta);y01 = Yz-L2*sin(beta);原点的圆心x02 = Xz+L2*cos(beta);y02 = Yz+L2*sin(beta); 原点的圆心endif(NorF=1)%判断圆心位置if(x012+y01

3、2-x022-y022)=0)x0=x01;y0=y01;elsex0=x02;y0=y02;end%远离elseendif(x012+y012-x022-y022)h*h/2|(step=0&mark=0) if(Xm-x0)0&(Ym-y0)=0)XOY=1;%判断动点所在象限endif(Xm-x0)0)XOY=2;endif(Xm-x0)0&(Ym-y0)=0&(Ym-y0)=0)else if(Fm=0)x1=Xm,Xm;y1=Ym,Ym-h; else x1=Xm,Xm+h;y1=Ym,Ym;endx1=Xm,Xm;y1=Ym,Ym+h; else x1=Xm,Xm-h;y1=Ym,

4、Ym;endelse if(Fm0)end case 3if(SorN=1) if(Fm=0)x1=Xm,Xm+h;y1=Ym,Ym;else x1=Xm,Xm;y1=Ym,Ym+h; endx1=Xm,Xm;y1=Ym,Ym-h; else x1=Xm,Xm-h;y1=Ym,Ym;endx1=Xm,Xm;y1=Ym,Ym+h; else x1=Xm,Xm-h;else if(Fm0)end case 4if(SorN=1) if(Fm=0)else if(Fm0)y1=Ym,Ym;endx1=Xm,Xm+h;y1=Ym,Ym;else x1=Xm,Xm;y1=Ym,Ym-h; endx1=Xm,Xm-h;y1=Ym,Ym;else x1=Xm,Xm;y1=Ym,Ym-h; endend endx1=Xm,Xm;y1=Ym,Ym+h; else x1=Xm,Xm+h;y1=Ym,Ym;endstep=step+1;plot(x1,y1,r-);2Xm=x1(2);与比较时使用Ym=y1(2);Fm = (Xm-x0)2+(Ym-y0)2-R2;hold on; text(x1(1)+x1(2)/2,(y1(1)+y1(2)/2,nu