无聊写matlab仿真直线插补算法

CK345

X0 = input('请输入起点横坐标 X\n X0 = ');
Y0 = input('请输入起点纵坐标 Y\n Y0 = ');
Xe = input('请输入终点横坐标 X\n Xe = ');
Ye = input('请输入终点纵坐标 Y\n Ye = ');
h = input('输入步长\n h = ');
x=[X0,Xe];
y=[Y0,Ye];
plot(x,y);
hold on;
Xe=Xe-X0;
Ye=Ye-Y0;
NXY= (abs(Xe)+abs(Ye))/h;
step=0;
Fm=0;
Xm=X0;
Ym=Y0;
if(Xe>0&Ye>=0)  XOY=1;
end
if(Xe<=0&Ye>0)  XOY=2;
end
if(Xe<0&Ye<=0)  XOY=3;
end
if(Xe>=0&Ye<0)  XOY=4;
end
while (step<NXY)
switch XOY                        
        case 1
            if(Fm>=0)
            x1=[Xm,Xm+h];         
            y1=[Ym,Ym];
            else
            x1=[Xm,Xm];         
            y1=[Ym,Ym+h];
            end
        case 2
            if(Fm<0)
            x1=[Xm,Xm-h];         
            y1=[Ym,Ym];
            else
            x1=[Xm,Xm];         
            y1=[Ym,Ym+h];
            end  
  case 3
            if(Fm>=0)
            x1=[Xm,Xm-h];         
            y1=[Ym,Ym];
            else
            x1=[Xm,Xm];         
            y1=[Ym,Ym-h];
            end      
case 4
           if(Fm<0)
            x1=[Xm,Xm+h];         
            y1=[Ym,Ym];
            else
            x1=[Xm,Xm];         
            y1=[Ym,Ym-h];
            end
end
   step=step+1;
    plot(x1,y1,'r-');                 %由此点和前一点坐标组成的2个向量画直线
    Xm=x1(2);                    %保存此点坐标供下次作图和比较时使用
Ym=y1(2);
Fm=(Ym-Y0)*Xe-(Xm-X0)*Ye;
hold on;
text((x1(1)+x1(2))/2,(y1(1)+y1(2))/2,[num2str(step)])                                            
    pause(0.5);                    %延时程序形参为每走一步所用时间  
end
xlabel('X')
ylabel('Y')
title(['四象限直线插补'])
hold off;

霸气侧漏

不错不错，挺好的