直线及圆弧插补程序--逐点比较法.doc

此程序是根据微型计算机控制技术(第二版)清华大学出版社第三章数字控制技术3.2插补原理中的3.2.1逐点比较法的直线插补，3.2.2逐点比较法圆弧插补编写的。其中的变量定义，原理依据均来源于此，如有疑问，请参考书中的讲解。尤其是例子，以下两个程序的第一个运行图均与例题中的一致。 一、四象限直线插补程序分别加工第一、二、三、四象限直线，起点均为（0,0），终点坐标为（NX，NY），进行插补计算。程序中（NX，NY）为终点坐标；NXY为总步数；XOY=1,2,3,4，分别为第一、二、三、四象限; ZF=1,2,3,4，分别代表+x,-x,+y,-y走步方向；FM为加工点偏差，初值为0。源程序：# include stdio.h# include string.h# include math.hvoid main() int NX,NY,NXY,BS,XOY,ZF;int FM=0; char a10=+X,b10=-X,c10=+Y,d10=-Y,e10; printf(nn请输入NX,NYn); scanf(%d %d,&NX,&NY); if(NX0) if(NY0) XOY=1; else XOY=4; else if(NY0) XOY=2; else XOY=3; printf(终点在第%d象限n,XOY); printf(n 步数 坐标进给 偏差计算 终点判断nn); BS=fabs(NX) + fabs(NY);for(NXY= fabs(NX) + fabs(NY)-1;NXY=0;NXY-) if(FM=0)if(XOY=1|XOY=4) ZF=1;strcpy(e,a); elseZF=2; strcpy(e,b); FM=FM-fabs(NY); printf( %d %s FM=%d NXY=%dnn,BS-NXY,e, FM,NXY); elseif(XOY=1|XOY=2)ZF=3;strcpy(e,c);elseZF=4;strcpy(e,d);FM=FM+fabs(NX); printf( %d %s FM=%d NXY=%dnn,BS-NXY,e, FM,NXY);图一：插补计算过程第一象限直线OA，起点为（0,0），终点坐标为A（6,4）图二：插补计算过程第二象限直线OA，起点为（0,0），终点坐标为A（-3,2）图三：插补计算过程第三象限直线OA，起点为（0,0），终点坐标为A（-2,-3）图四：插补计算过程第四象限直线OA，起点为（0,0），终点坐标为A（3,-2）二四象限逐点比较法圆弧插补加工逆圆弧（或顺圆弧）AB,圆弧的圆心在坐标原点，已知起点坐标为（X0，Y0）终点坐标（NX，NY）。程序中（X0，Y0）为起点坐标；（NX，NY）为终点坐标；NXY为总步数；RNS=1,2,3,4，5,6,7,8，分别为八种圆弧（SR1，SR2，SR3，SR4，NR1，NR2，NR3，NR4，其中SR表示逆圆弧，NR表示顺圆弧，）第一至第四象限的顺圆弧和逆圆弧; ZF=1,2,3,4，分别代表+x,-x,+y,-y走步方向；FM为加工点偏差，初值为0。圆弧插补计算公式和进给方向偏差圆弧种类进给方向偏差计算坐标计算FM=0SR1,NR2-yFm+1= Fm-2ym+1Xm+1=xm;ym+1=ym-1SR3,NR4 +yNR1,SR4 -xFm+1= Fm-2xm+1Xm+1=xm-1; ym+1=ymNR3,SR2 +xFM0SR1,NR4 +xFm+1= Fm+2xm+1Xm+1=xm+1; ym+1=ymSR3,NR2 -xNR1,SR2 +yFm+1= Fm+2ym+1Xm+1=xm; ym+1=ym+1NR3,SR4 -y源程序：# include stdio.h# include string.h# include math.hvoid main() int NX,NY,NXY,BS,RNS,ZF,X0=0,Y0=0,XM,YM;int FM=0; char a10=+X,b10=-X,c10=+Y,d10=-Y,e10; printf(请输入X0,Y0,NX,NYn); scanf(%d %d %d %d,&X0,&Y0,&NX,&NY); if(X0NY) if(X00) RNS=7; else RNS=1; else if(X00) RNS=8; else RNS=2; else if(Y0NY) if(X00) RNS=4; else RNS=6; else if(X00) RNS=5; else RNS=3; printf(该圆弧为%dn,RNS); BS=fabs(NX-X0) + fabs(NY-Y0);XM=X0;YM=Y0; for(NXY= 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; printf( %d %s FM=%d XM=%d,YM=%d NXY=%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=YM-1; printf( %d %s FM=%d XM=%d,YM=%d NXY=%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; printf( %d %s FM=%d XM=%d,YM=%d NXY=%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*f