圆弧插补逐点比较法(MATLAB版)

functionmyfun=pbpCircleintpol(x0,y0,x1,y1)%x0,y0,x1,y1分别为起始点横、纵坐标和终止点的横、纵坐标%以下程序是将图形限制在area区域内，并且将网格间距调整为1个单位长度area=max(max(x0,y0),max(x1,y1));plot([00],[areaarea]);gridonset(gca,'XTick',[0:1:area])set(gca,'YTick',[0:1:area])holdon;%以下部分程序是画出需要加工的工件轮廓r=sqrt(y0^2+x0^2);%求圆的半径theta0=atan(y0/x0);theta1=atan(y1/x1);theta=theta0:0.01:theta1dx=r*cos(theta);dy=r*sin(theta);plot(dx,dy);holdon;%以下部分程序是模拟走刀路径num=abs(x0-x1)+abs(y0-y1);px=x0;py=y0;rxy=r;%当前位置离圆心距离，初始化为rfori=1:numlastX=px;lastY=py;%lastX，lastY为走刀之前的位置坐标if(rxyr)py=py+1;elsepx=px-1;endline([lastXpx],[lastYpy],'Marker','.','Color','r','Linestyle','-','LineWidth',2);rxy=sqrt(px^2+py^2);pause(.5);%每走一步暂停0.5秒end