shuxuebiaodashi2.m

机器人运行轨迹计算

if kk==1
nx=0.2689;ny=-0.2551;nz=-0.9285;
ox=-0.6870;oy=-0.7267;oz=0;
ax=-0.6747;ay=0.6379;az=-0.3714;
px=320;py=-104;pz=20.0085;
elseif kk==2
nx=-0.2404;ny=0.2831;nz=-0.9285;
ox=0.7623;oy=0.6472;oz=0;
ax=0.6009;ay=-0.7078;az=-0.3714;
px=120;py=106;pz=50.8244;
elseif kk==3
nx=-0.0587;ny=-0.3667;nz=-0.9285;
ox=-0.9874;oy=0.1580;oz=0;
ax=0.1467;ay=0.9168;az=-0.3714;
px=190;py=-125;pz=81.9846;
elseif kk==4
nx=0.1691;ny=0.3307;nz=-0.9285;
ox=0.8903;oy=-0.4553;oz=0;
ax=-0.4227;ay=-0.8267;az=-0.3714;
px=255;py=88;pz=151.3637;
end