求工作空间的边界
程序如下:clear all;
clc;
tic;
A10=[-400/2;320/2;0]; %运动平台上各球铰点在动坐标系下的矢量表示
A20=[-400/2;-320/2;0];
A30=;
A40=;
A50=;
A60=[-320/2;0;-400/2];
T=
C1=[-(400/2+500+400);320/2;0]; %各分支与基座连接点在定坐标系下的矢量表示
C2=[-(400/2+500+400);-320/2;0];
C3=;
C4=;
C5=;
C6=[-320/2;0;-(400/2+500+400)];
k=1;
xdata=0;
ydata=0;
for r=0:10:300
for a=0:2*pi/100:2*pi
x=r*cos(a);
y=r*sin(a);
A1=T*A10+;
A2=T*A20+;
A3=T*A30+;
A4=T*A40+;
A5=T*A50+;
A6=T*A60+;
l1=500+x-sqrt(500^2-y^2-0^2);
l2=500+x-sqrt(500^2-y^2-0^2);
l3=500+y-sqrt(500^2-x^2-0^2);
l4=500+y-sqrt(500^2-x^2-0^2);
l5=500+0-sqrt(500^2-x^2-y^2);
l6=500+0-sqrt(500^2-x^2-y^2);
B1=[-(400/2+500-l1);320/2;0]; %虎可铰各点在固定坐标系下的矢量表示
B2=[ -(400/2+500-l2);-320/2;0];
B3=;
B4=;
B5=;
B6=[-320/2;0;-(400/2+500-l6)];
zeta1=(B1-A1)/500;
zeta2=(B2-A2)/500;
zeta3=(B3-A3)/500;
zeta4=(B4-A4)/500;
zeta5=(B5-A5)/500;
zeta6=(B6-A6)/500;
eta1=(C1-B1)/abs(400+l1);
eta2=(C2-B2)/abs(400+l2);
eta3=(C3-B3)/abs(400+l3);
eta4=(C4-B4)/abs(400+l4);
eta5=(C5-B5)/abs(400+l5);
eta6=(C6-B6)/abs(400+l6);
delta1=acos(dot(zeta1,T*eta1));
delta2=acos(dot(zeta2,T*eta2));
delta3=acos(dot(zeta3,T*eta3));
delta4=acos(dot(zeta4,T*eta4));
delta5=acos(dot(zeta5,T*eta5));
delta6=acos(dot(zeta6,T*eta6));
theta1=acos(dot(zeta1,eta1));
theta2=acos(dot(zeta2,eta2));
theta3=acos(dot(zeta3,eta3));
theta4=acos(dot(zeta4,eta4));
theta5=acos(dot(zeta5,eta5));
theta6=acos(dot(zeta6,eta6));
if if ((l1>=-200)&(l1<=200)&(l2>=-200)&(l2<=200)&(l3>=-200)&(l3<=200)&(l4>=-200)&(l4<=200)&(l5>=-200)&(l5<=200)&(l6>=-200)&(l6<=200)&(delta1>=0)&(delta1<=pi/6)&(delta2>=0)&(delta2<=pi/6)&(delta3>=0)&(delta3<=pi/6)&(delta4>=0)&(delta4<=pi/6)&(delta5>=0)&(delta5<=pi/6)&(delta6>=0)&(delta6<=pi/6)&(theta1>=0)&(theta1<=pi/6)&(theta2>=0)&(theta2<=pi/6)&(theta3>=0)&(theta3<=pi/6)&(theta4>=0)&(theta4<=pi/6)&(theta5>=0)&(theta5<=pi/6)&(theta6>=0)&(theta6<=pi/6))
xdata(k)=x;
ydata(k)=y;
k=k+1;
end
end
end
toc
plot(xdata,ydata)
xlabel('x/mm');ylabel('y/mm')
如果只要此程序仿真出的工作空间的边界,应该怎么修改程序啊?谁能帮我一下吗? 楼主,交流一下吧QQ68196541 你贴得程序似乎多了个 if 。如果我没理解错的的话,你只要在上述程序结尾加上以下代码即可:
hold on
b_id = convhull(xdata,ydata);
b_x = xdata(b_id); % 边界点x坐标
b_y = ydata(b_id); % 边界点y坐标
plot(b_x, b_y, 'r-', 'LineWidth', 2);
页:
[1]