X0 = ');
Y0=input('请输入起点纵轴坐标Y\
Y0 = ');
Xe=input('请输入终点横轴坐标X\
Xe =');
Ye=input('请输入终点纵轴坐标 Y\
Ye = ');
R=input('请输入圆弧半径\
R = ');
NorF=input('请选择圆心(1代表靠近原点 2代表远离原点):\
');
SorN=input('请选择补走向(1代表顺时针/2代表逆时针):\
');
h=input('请输入步长\
h = ');
if((Xe==X0)&(Ye==Y0))
x01 = 0; y01 = 0;
x02 = 2*Xe; y02 = 2*Ye;
R = sqrt(Xe^2+Ye^2);
mark = 0;
else
mark = 1;
k1 = (Ye-Y0)/(Xe-X0);
k2 = -1/k1;
Xz=(X0+Xe)/2; Yz=(Y0+Ye)/2; %两点中点坐标
L1=sqrt((X0-Xe)^2+(Y0-Ye)^2)/2 ; %两点之间距离的一半
L2=sqrt(R^2-L1^2);
beta = atan(k2);
x01 = Xz-L2*cos(beta); y01 = Yz-L2*sin(beta); %靠近原点的圆心
x02 = Xz+L2*cos(beta); y02 = Yz+L2*sin(beta); %远离原点的圆心
end
if(NorF==1) %判断圆心位置
if((x01^2+y01^2-x02^2-y02^2)<=0)
x0=x01; y0=y01;
else
x0=x02; y0=y02;
end
else
if((x01^2+y01^2-x02^2-y02^2)<=0)
x0=x02; y0=y02;
else
x0=x01; y0=y01;
end
end
%画基准圆
alpha=0:pi/100000:2*pi;
xx=R*cos(alpha)+x0;
yy=R*sin(alpha)+y0;
plot(xx,yy,'g:');
hold on;
xx0=R/40*cos(alpha)+x0;
yy0=R/40*sin(alpha)+y0;
plot(xx0,yy0,'r:');
hold on;
axis equal;
Xm = X0;
Ym = Y0;
%NXY= (abs(Xe-X0)+abs(Ye-Y0))/h;
step=0;
Fm=0;
while ((Xm-Xe)^2+(Ym-Ye)^2>h*h/2|(step==0&mark==0))
if((Xm-x0)>0&(Ym-y0)>=0) XOY=1; %判断动点所在象限
end
if((Xm-x0)<=0&(Ym-y0)>0) XOY=2;
end
if((Xm-x0)<0&(Ym-y0)<=0) XOY=3;
end
if((Xm-x0)>=0&(Ym-y0)<0) XOY=4;
end
switch XOY
case 1
if(SorN==1)
if(Fm>=0)
x1=[Xm,Xm];
y1=[Ym,Ym-h];
else
x1=[Xm,Xm+h];
y1=[Ym,Ym];
end
else
if(Fm<=0)
x1=[Xm,Xm];
y1=[Ym,Ym+h];
else
x1=[Xm,Xm-h];
y1=[Ym,Ym];
end
end
case 2
if(SorN==1)
if(Fm>=0)
x1=[Xm,Xm+h];
y1=[Ym,Ym];
else
x1=[Xm,Xm];
y1=[Ym,Ym+h];
end
else
if(Fm>0)
x1=[Xm,Xm];
y1=[Ym,Ym-h];
else
x1=[Xm,Xm-h];
y1=[Ym,Ym];
end
end
case 3
if(SorN==1)
if(Fm>=0)
x1=[Xm,Xm];
y1=[Ym,Ym+h];
else
x1=[Xm,Xm-h];
y1=[Ym,Ym];
end
else
if(Fm>0)
x1=[Xm,Xm+h];
y1=[Ym,Ym];
else
x1=[Xm,Xm];
y1=[Ym,Ym-h];
end
end
case 4
if(SorN==1)
if(Fm>=0)
x1=[Xm,Xm-h];
y1=[Ym,Ym];
else
x1=[Xm,Xm];
y1=[Ym,Ym-h];
end
else
if(Fm>=0)
x1=[Xm,Xm];
y1=[Ym,Ym+h];
else
x1=[Xm,Xm+h];
y1=[Ym,Ym];
end
end
end
step=step+1;
plot(x1,y1,'r-'); %由此点和前一点坐标组成的2个向量画直线
Xm=x1(2); %保存此点坐标供下次作图和比较时使用
Ym=y1(2);
Fm = (Xm-x0)^2+(Ym-y0)^2-R^2;
hold on;
text((x1(1)+x1(2))/2,(y1(1)+y1(2))/2,[num2str(step)])
pause(0.5); %延时程序形参为每走一步所用时间
end
xlabel('X')
ylabel('Y')
x03 = roundn(x0,-2);
y03 = roundn(y0,-2);
text(x0,y0,['(' num2str(x03) ',' num2str(y03) ')']); %标记圆心坐标
title(['四象限圆弧插补'])
hold off;下载本文
