Matlab圓弧插補(bǔ)程序鄭國(guó)安

1、第 第8頁(yè)MatlabX0=input(請(qǐng)輸入起點(diǎn)橫軸坐標(biāo)Xn X0 = ); Y0=input(請(qǐng)輸入起點(diǎn)縱軸坐標(biāo)Yn Y0 = ); Xe=input(請(qǐng)輸入終點(diǎn)橫軸坐標(biāo)Xn Xe =); Ye=input(請(qǐng)輸入終點(diǎn)縱軸坐標(biāo) Yn Ye = ); R=input(n R = );NorF=input(請(qǐng)選擇圓心 (1 代表靠近原點(diǎn)2 代表遠(yuǎn)離原點(diǎn)):n);SorN=input(請(qǐng)選擇補(bǔ)走向(1 代表順時(shí)針/2 代表逆時(shí)針):n );h=input(請(qǐng)輸入步長(zhǎng)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;%兩點(diǎn)中點(diǎn)坐標(biāo)L1=sqrt(X0-Xe)2+(Y0-Ye)2)/2 ;%兩點(diǎn)之間距離一半L2=sqrt(R2-L12); beta = atan(k2);x01 = Xz-L2*cos(beta);y01 = Yz-L2*sin(beta);原點(diǎn)的圓心x02 = Xz+L2*cos(beta);y02 = Yz+L2*sin(beta); 原點(diǎn)的圓心endif(NorF=1)%判斷圓心位置if(x012+y01

3、2-x022-y022)=0)x0=x01;y0=y01;elsex0=x02;y0=y02;end%遠(yuǎn)離elseendif(x012+y012-x022-y022)h*h/2|(step=0&mark=0) if(Xm-x0)0&(Ym-y0)=0)XOY=1;%判斷動(dòng)點(diǎn)所在象限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);與比較時(shí)使用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