四轴五轴宏联动算法(八)

Tualar

else if (v1 == 0.0 && v2 < 0.0 && x == 0.0)
      { //v1=0,V2<0,x=0
        if (w2 == 1.0)s = "X[-#103]";
        else s.Format("X[-%s*#103]", s2);
      }
      else if (v1 == 0.0 && v2 < 0.0 && x < 0.0)
      { //v1=0,V2<0,x<0
        if (w2 == 1.0)s.Format("X[-#103-%s]", s3);
        else s.Format("X[-%s*#103-%s]", s2, s3);
      }
      else if (v1 < 0.0 && v2 > 0.0 && x > 0.0)
      { //v1<0,V2>0,x>0
        if (w1 == 1.0 && w2 == 1.0)
          s.Format("X[-#101+#103+%s]", s3);
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("X[-#101+%s*#103+%s]", s2, s3);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("X[-%s*#101+#103+%s]", s1, s3);
        else s.Format("X[-%s*#101+%s*#103+%s]", s1, s2, s3);
      }
      else if (v1 < 0.0 && v2 > 0.0 && x == 0.0)
      { //v1<0,V2>0,x=0
        if (w1 == 1.0 && w2 == 1.0)s = "X[-#101+#103]";
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("X[-#101+%s*#103]", s2);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("X[-%s*#101+#103]", s1);
        else s.Format("X[-%s*#101+%s*#103]", s1, s2);
      }
      else if (v1 < 0.0 && v2 > 0.0 && x < 0.0)
      { //v1<0,V2>0,x<0
        if (w1 == 1.0 && w2 == 1.0)
          s.Format("X[-#101+#103-%s]", s3);
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("X[-#101+%s*#103-%s]", s2, s3);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("X[-%s*#101+#103-%s]", s1, s3);
        else s.Format("X[-%s*#101+%s*#103-%s]", s1, s2, s3);
      }
      else if (v1 < 0.0 && v2 == 0.0 && x > 0.0)
      { //v1<0,V2=0,x>0
        if (w1 == 1.0)s.Format("X[-#101+%s]", s3);
        else s.Format("X[-%s*#101+%s]", s1, s3);
      }
      else if (v1 < 0.0 && v2 == 0.0 && x == 0.0)
      { //v1<0,V2=0,x=0
        if (w1 == 1.0)s = "X[-#101]";
        else s.Format("X[-%s*#101]", s1);
      }
      else if (v1 < 0.0 && v2 == 0.0 && x < 0.0)
      { //v1<0,V2=0,x<0
        if (w1 == 1.0)s.Format("X[-#101-%s]", s3);
        else s.Format("X[-%s*#101-%s]", s1, s3);
      }
      else if (v1 < 0.0 && v2 < 0.0 && x > 0.0)
      { //v1<0,V2<0,x>0
        if (w1 == 1.0 && w2 == 1.0)
          s.Format("X[-#101-#103+%s]", s3);
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("X[-#101-%s*#103+%s]", s2, s3);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("X[-%s*#101-#103+%s]", s1, s3);
        else s.Format("X[-%s*#101-%s*#103+%s]", s1, s2, s3);
      }
      else if (v1 < 0.0 && v2 < 0.0 && x == 0.0)
      { //v1<0,V2<0,x=0
        if (w1 == 1.0 && w2 == 1.0)s = "X[-#101-#103]";
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("X[-#101-%s*#103]", s2);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("X[-%s*#101-#103]", s1);
        else s.Format("X[-%s*#101-%s*#103]", s1, s2);
      }
      else if (v1 < 0.0 && v2 < 0.0 && x < 0.0)
      { //v1<0,V2<0,x<0
        if (w1 == 1.0 && w2 == 1.0)
          s.Format("X[-#101-#103-%s]", s3);
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("X[-#101-%s*#103-%s]", s2, s3);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("X[-%s*#101-#103-%s]", s1, s3);
        else s.Format("X[-%s*#101-%s*#103-%s]", s1, s2, s3);
      }
  return s;
}

//计算五轴AC宏联动Y坐标
CString Calc_AC_Y(double y, double a, double c)
{
  CString s, s1, s2, s3, s4;
  double v1, v2, v3, w1, w2, w3;
      v1 = r6(cos(a*RAD)*cos(c*RAD)-1.0);
      v2 = r6(-1.0*cos(a*RAD)*sin(c*RAD));
      v3 = r6(sin(a*RAD));
      w1 = fabs(v1);
      w2 = fabs(v2);
      w3 = fabs(v3);
      s1 = e0(fabs(v1));
      s2 = e0(fabs(v2));
      s3 = e0(fabs(v3));
      s4 = d0(fabs(y));
      if (v1 > 0.0 && v2 > 0.0 && v3 > 0.0 && y > 0.0)
      { //v1>0,v2>0,v3>0,y>0
        if (w1==1.0 && w2==1.0 && w3==1.0)
          s.Format("Y[#102+#101+#103+%s]", s4);
        else if (w1 == 1.0 && w2 != 1.0 && w3 != 1.0)
          s.Format("Y[#102+%s*#101+%s*#103+%s]", s2, s3, s4);
        else if (w1 != 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[%s*#102+#101+%s*#103+%s]", s1, s3, s4);
        else if (w1 != 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+%s*#101+#103+%s]", s1, s2, s4);
        else if (w1 == 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[#102+#101+%s*#103+%s]", s3, s4);
        else if (w1 == 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[#102+%s*#101+#103+%s]", s2, s4);
        else if (w1 != 1.0 && w2 == 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+#101+#103+%s]", s1, s4);
        else s.Format("Y[%s*#102+%s*#101+%s*#103+%s]", s1, s2, s3, s4);
      }
      else if (v1 > 0.0 && v2 > 0.0 && v3 > 0.0 && y == 0.0)
      { //v1>0,v2>0,v3>0,y=0
        if (w1 == 1.0 && w2 == 1.0 && w3 == 1.0)
          s = "Y[#102+#101+#103]";
        else if (w1 == 1.0 && w2 != 1.0 && w3 != 1.0)
          s.Format("Y[#102+%s*#101+%s*#103]", s2, s3);
        else if (w1 != 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[%s*#102+#101+%s*#103]", s1, s3);
        else if (w1 != 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+%s*#101+#103]", s1, s2);
        else if (w1 == 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[#102+#101+%s*#103]", s3);
        else if (w1 == 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[#102+%s*#101+#103]", s2);
        else if (w1 != 1.0 && w2 == 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+#101+#103]", s1);
        else s.Format("Y[%s*#102+%s*#101+%s*#103]", s1, s2, s3);        
      }
      else if (v1 > 0.0 && v2 > 0.0 && v3 > 0.0 && y < 0.0)
      { //v1>0,v2>0,v3>0,y<0
        if (w1 == 1.0 && w2 == 1.0 && w3 == 1.0)
          s.Format("Y[#102+#101+#103-%s]", s4);
        else if (w1 == 1.0 && w2 != 1.0 && w3 != 1.0)
          s.Format("Y[#102+%s*#101+%s*#103-%s]", s2, s3, s4);
        else if (w1 != 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[%s*#102+#101+%s*#103-%s]", s1, s3, s4);
        else if (w1 != 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+%s*#101+#103-%s]", s1, s2, s4);
        else if (w1 == 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[#102+#101+%s*#103-%s]", s3, s4);
        else if (w1 == 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[#102+%s*#101+#103-%s]", s2, s4);
        else if (w1 != 1.0 && w2 == 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+#101+#103-%s]", s1, s4);
        else s.Format("Y[%s*#102+%s*#101+%s*#103-%s]", s1, s2, s3, s4);
      }
      else if (v1 > 0.0 && v2 > 0.0 && v3 == 0.0 && y > 0.0)
      { //v1>0,v2>0,v3=0,y>0
        if (w1 == 1.0 && w2 == 1.0)
          s.Format("Y[#102+#101+%s]", s4);
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("Y[#102+%s*#101+%s]", s2, s4);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("Y[%s*#102+#101+%s]", s1, s4);
        else s.Format("Y[%s*#102+%s*#101+%s]", s1, s2, s4);            
      }
      else if (v1 > 0.0 && v2 > 0.0 && v3 == 0.0 && y == 0.0)
      { //v1>0,v2>0,v3=0,y=0
        if (w1 == 1.0 && w2 == 1.0)s = "Y[#102+#101]";
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("Y[#102+%s*#101]", s2);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("Y[%s*#102+#101]", s1);
        else s.Format("Y[%s*#102+%s*#101]", s1, s2);                    
      }
      else if (v1 > 0.0 && v2 > 0.0 && v3 == 0.0 && y < 0.0)
      { //v1>0,v2>0,v3=0,y<0
        if (w1 == 1.0 && w2 == 1.0)
          s.Format("Y[#102+#101-%s]", s4);
        else if (w1 == 1.0 && w2 != 1.0)
          s.Format("Y[#102+%s*#101-%s]", s2, s4);
        else if (w1 != 1.0 && w2 == 1.0)
          s.Format("Y[%s*#102+#101-%s]", s1, s4);
        else s.Format("Y[%s*#102+%s*#101-%s]", s1, s2, s4);            
      }
      else if (v1 > 0.0 && v2 > 0.0 && v3 < 0.0 && y > 0.0)
      { //v1>0,v2>0,v3<0,y>0
        if (w1 == 1.0 && w2 == 1.0 && w3 == 1.0)
          s.Format("Y[#102+#101-#103+%s]", s4);
        else if (w1 == 1.0 && w2 != 1.0 && w3 != 1.0)
          s.Format("Y[#102+%s*#101-%s*#103+%s]", s2, s3, s4);
        else if (w1 != 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[%s*#102+#101-%s*#103+%s]", s1, s3, s4);
        else if (w1 != 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+%s*#101-#103+%s]", s1, s2, s4);
        else if (w1 == 1.0 && w2 == 1.0 && w3 != 1.0)
          s.Format("Y[#102+#101-%s*#103+%s]", s3, s4);
        else if (w1 == 1.0 && w2 != 1.0 && w3 == 1.0)
          s.Format("Y[#102+%s*#101-#103+%s]", s2, s4);
        else if (w1 != 1.0 && w2 == 1.0 && w3 == 1.0)
          s.Format("Y[%s*#102+#101-#103+%s]", s1, s4);
        else s.Format("Y[%s*#102+%s*#101-%s*#103+%s]", s1, s2, s3, s4);
      }
未完待续。。。。