直線及圓弧插補(bǔ)程序逐點(diǎn)比較法

1、此程序是根據(jù)微型計(jì)算機(jī)控制技術(shù)（第二版）清華大學(xué)出版社 第三章數(shù)字控制技術(shù) 3.2插補(bǔ)原理中的321逐點(diǎn)比較法的直線 插補(bǔ)，逐點(diǎn)比較法圓弧插補(bǔ)編寫的。其中的變量定義，原理依 據(jù)均來源于此，如有疑問，請(qǐng)參考書中的講解。尤其是例子，以下兩 個(gè)程序的第一個(gè)運(yùn)行圖均與例題中的一致。一、四象限直線插補(bǔ)程序分別加工第一、二、三、四象限直線，起點(diǎn)均為（0,0），終點(diǎn)坐標(biāo)為（NX , NY）， 進(jìn)行插補(bǔ)計(jì)算。程序中（NX，NY）為終點(diǎn)坐標(biāo)；NXY為總步數(shù)；XOY=1,2,3,4，分別為第一、二、三、四 象限；ZF=1,2,3,4，分別代表+x,-x,+y,-y走步方向；FM為加工點(diǎn)偏差，初值為0。源程序：#

2、in elude stdio.h# in elude stri ng.h# in elude math.hvoid mai n（） int NX,NY,NXY,BS,XOY,ZF;int FM=0;char a10=+X,b10=-X,c10=+Y,d10=-Y,e10;printf（nn請(qǐng)輸入 NX,NYn）;sea nf（%d %d,&N X,&N Y）;if(NX0)：(qo)AcbisNTZ 3S|3(0o)Acbis!l=dZ (K=人 OXl l=人 0X)M(0=l/ld)4!(-AXN：0=AXN! k(AN)sqe)+ (XN)sqe)二人XN)0j !(AN)sqe)+ (

3、XN)sqe)=sg直44至削翳率洱兩滋乎 u.)BuuddOXlu釧碧p%蚩丑沖場(chǎng) “)#U!d：e=A0x3S|3N人OX(O 人 N)j!3S|3P=AOX3S|3EOX(O=0SR1,NR2-yFm+1 = F m-2ym+1Xm+1= Xm ；ym+1 =y m-1SR3,NR4+yNR1,SR4-xFm+1 = F m-2xm+1Xm+1= Xm -1； y m+1 =y mNR3,SR2+xFM0SR1,NR4+xFm+1 = F m+2xm+1Xm+1= Xm +1； y m+1 =y mSR3,NR2-xNR1,SR2+yFm+1 = F m+2ym+1Xm+1= Xm ；

4、ym+1 =y m+1NR3,SR4-y so6OUSNMOAOX)七 so 匚SNM so叮SNMOAOX)七(anaoam(xnvoxmman03xn03oa03-ox03-=p% P% P% p%=ueos MMAN-XN-OA-OX =lreE= pnQu 云=IT6UES= pnQu 云izopls- pnQu 云RNS=2;elseif(YONY)if(X00)RNS=4;elseRNS=6;elseif(X00)RNS=5;elseRNS=3;printf(” 該圓弧為 dn”,RNS);BS=fabs(NX-XO) + fabs(NY-YO);XM=X0;YM=Y0;for(N

5、XY= fabs(NX-X0) + fabs(NY-Y0)-1;NXY=0;NXY-)if(RNS=1|RNS=3|RNS=6|RNS=8)if(FM=0)if(RNS=1|RNS=8)ZF=1;strcpy(e,a);elseZF=2;strcpy(e,b);FM=FM+2*fabs(XM)+1;XM=XM+1;prin tf( %d%sFM=%dXM=%d,YM=%dNXY=%dnn ”,BS-NXY,e, FM,XM,YM,NXY);elseif(RNS=1|RNS=6)ZF=3;strcpy(e,c);elseZF=4;strcpy(e,d);FM=FM-2*fabs(YM)+1;YM

6、=YM-1;XM=%d,YM=%dprintf( %d%sFM=%dNXY=%dnn ”,BS-NXY,e, FM,XM,YM,NXY);elseif(FM=0)if(RNS=2|RNS=7)ZF=1;strcpy(e,a);elseZF=2;strcpy(e,b);FM=FM-2*fabs(XM)+1;XM=XM-1;XM=%d,YM=%dprintf( %d%sFM=%dNXY=%dnn ”,BS-NXY,e, FM,XM,YM,NXY);elseif(RNS=2|RNS=5) ZF=3;strcpy(e,c);elseZF=4;strcpy(e,d);FM=FM+2*fabs(YM)+1;YM=YM+1;FM=%dXM=%d,YM=%dprin tf(%d%sNXY=%dnn ”,BS-NXY,e, FM,XM,YM,NXY);第一象限逆圓弧 A - B,圓弧的圓心在坐標(biāo)原點(diǎn)，已知起點(diǎn)坐標(biāo)為（0,4 ）終點(diǎn)坐標(biāo)（4,0 ）。圓弧插