DDA直线插补算法在单片机上的实现基于C.docVIP

/*-------------------------------*/ /*时间2011年11月*/ /*功能：DDA 插补算法在单片机上实现*/ /*作者JC*/ /*-------------------------------*/ #include reg51.h #includestdio.h #define uchar unsigned char #define uint unsigned int #define Xe 8 //定义初始点坐标 #define Ye 10 uchar code tab[]={0x03,0x09,0x0c,0x06}; //电机正传控制字 /*------------------------------*/ //定义a^b函数 /*------------------------------*/ uint pow(char a,char b) { uchar t=1; while(b--) t*=a; return t; } /*------------------------------*/ //定义求绝对值函数 /*--------------------------------*/ char abs(char a ) { return a0?a:(-a); } /*------------------------------*/ //定义求最大值函数 /*--------------; char max(char a,char b) { return abs(a)abs(b)? abs(a):abs(b); } */ /*--------------------------*/ //定义延时函数,延时tms /*------------------------------*/ void delay(uint t) { uchar i; for(;t0;t--) for(i=114;i0;i--); } /*------------------------------*/ /*求寄存器位数n*/ /*------------------------------*/ int res_n() { int m,n; for(m=1;m256;m++) { if(abs(Xe)abs(Ye)) { if(pow(2,m-1)=abs(Xe)abs(Xe)=pow(2,m)) { n = m; } } else { if(pow(2,m-1)=abs(Ye)abs(Ye)=pow(2,m)) { n = m; } } } return n; } /*------------------------------*/ /*DDA直线插补算法声明*/ /*------------------------------*/ void DDALine() { char i,j,t; int n; int X=0,Y=0,FX=0,FY=0; n=res_n(); for(i=0;ipow(2,n);i++) { if(abs(X)abs(Xe)||abs(Y)abs(Ye)) { FY=FY+abs(Ye); FX=FX+abs(Xe); if(FX=pow(2,n)) { FX=FX-pow(2,n); X=X+1; for(t=0;t12;t++) { for(j=0;j4;j