Bresenham直线插补算法及其Matlab实现

Bresenham算法用在直线插补上面。假设线段向量坐标a(x,y,z),选取x,y,z绝对值最大的作为累加溢出值c=|max(x,y,z)|,假定累加初值b=c/2,那么三个轴输出脉冲的算法如下:

m=l=k=b;
for(i=0;i=c)
    {
        x轴输出一个脉冲;
        m-=c;
    }        

    if(l>=c)
    {
        y轴输出一个脉冲;
        l-=c;
    }
        
    if(k>=c)
    {
       z轴输出一个脉冲;
       k-=c;
    }

}

上面实现的是三轴插补算法,下面用Matlab实现了一个平面俩轴的直线插补算法:

img=zeros(500);
x1=20;y1=40;x2=500;y2=400;
x = x1;
y = y1;
img(x,y)=1;
stepX=abs(x2-x1);
stepY=abs(y2-y1);
maxStep = stepX;
if maxStepmaxStep
        cnt_x = cnt_x-maxStep;
        x = x+1;
        img(x,y)=1;
    end
    cnt_y = cnt_y+stepY;
    if cnt_y>maxStep
        cnt_y = cnt_y-maxStep;
        y = y+1;
        img(x,y)=1;
    end
    cnt_complete=cnt_complete+1;
end
imtool(img)

运行效果:

Bresenham直线插补算法及其Matlab实现_第1张图片

你可能感兴趣的:(运动控制)