DDA直线插补

%DDA数字积分法插补： %(xs,ys)起点坐标 %(xe,ye)起点坐标 %buffBitWidth 寄存器位宽 %base 基准:1全加载 2半加载 其他 普通 function DDA_Line2()%(xs,ys, xe,ye, buffBitWidth, base) %clc close all clear all global x y speed; %global x y m speed steplengh base zuo; %初始化参数------------------------------ speed=0.01; %speed of running插补速度. xs =0; % x start point x起始点 ys =0; % y start point y起始点 xe =1005; % x end point x终点 ye =1003; % y end point y终点 buffBitWidth=16;%寄存器位数 zuo=1;%左移偏置开关 1 开 0 关 base=1;%是否全加载,1全加载 2半加载 其他 普通 steplengh=1;%步长设置 %理论曲线绘制----------------------------- grid on; plot([xs,xe],[ys,ye],'r-');hold on; title('DDA直线插补图像'); xlabel('x'); ylabel('y'); % main part-------------------------------------------- if (xe-xs)>0 xdir = 1; else xdir = -1; end if (ye-ys)>0 ydir = 1; else ydir = -1; end jx0 = abs(xe-xs); jy0 = abs(ye-ys); if(zuo)%进行左移规格化操作 while(jx0&&jy0<=(0.5*2^buffBitWidth)) jx0=2*jx0; jy0=2*jy0; end end switch base case 1 jx=2^buffBitWidth; jy=2^buffBitWidth; case 2 jx=0.5*2^buffBitWidth; jy=0.5*2^buffBitWidth; otherwise jx=0; jy=0; end x=xs; y=ys; xplus = abs(xe-xs); yplus = abs(ye-ys); output(xs,ys); % move to start point. while(xplus>0 || yplus>0) jx=jx0+jx; jy=jy0+jy; if jx > 2^buffBitWidth&&jy>2^buffBitWidth xstep = redo(xplus, steplengh); ystep = redo(yplus, steplengh); output(xdir*xstep, ydir*ystep); x = x+xdir*xstep; y = y+ydir*ystep; xplus=xplus-xstep; yplus=yplus-ystep; jx=jx-2^buffBitWidth; jy=jy-2^buffBitWidth; end if jx>2^buffBitWidth&&jy<2^buffBitWidth xstep = redo(xplus, steplengh); output(xdir*xstep, 0); x = x+xdir*xstep; xplus=xplus-xstep; jx=jx-2^buffBitWidth; end if jx<2^buffBitWidth&&jy>2^buffBitWidth ystep = redo(yplus, steplengh); output(0, ydir*ystep); y = y+ydir*ystep; yplus=yplus-ystep; jy=jy-2^buffBitWidth; end end end function output(dx,dy) global x y speed; xi=x; yi=y; xj=x+dx; yj=y+dy; %if(dx) % dx=dx % disp('output') %end plot([xi,xj],[yi,yj],'b-');hold on; pause(speed); end function step = redo(data, n) if(data>0) step=n; else step=0; end end