四轴五轴宏联动算法(十一)

Tualar

else if (v1 == 0.0 && v2 < 0.0 && v3 == 0.0 && y < 0.0)
      {  //v1=0,v2<0,v3=0,y<0
        if (w2 == 1.0)s.Format("Y[-#101-%s]", s4);
        else s.Format("Y[-%s*#101-%s]", 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 (w2 == 1.0 && w3 == 1.0)
          s.Format("Y[-#101-#103+%s]", s4);
        else if (w2 == 1.0 && w3 != 1.0)
          s.Format("Y[-#101-%s*#103+%s]", s3, s4);
        else if (w2 != 1.0 && w3 == 1.0)
          s.Format("Y[-%s*#101-#103+%s]", s2, s4);
        else s.Format("Y[-%s*#101-%s*#103+%s]", 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 (w2 == 1.0 && w3 == 1.0)s = "Y[-#101-#103]";
        else if (w2 == 1.0 && w3 != 1.0)
          s.Format("Y[-#101-%s*#103]", s3);
        else if (w2 != 1.0 && w3 == 1.0)
          s.Format("Y[-%s*#101-#103]", s2);
        else s.Format("Y[-%s*#101-%s*#103]", 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 (w2 == 1.0 && w3 == 1.0)
          s.Format("Y[-#101-#103-%s]", s4);
        else if (w2 == 1.0 && w3 != 1.0)
          s.Format("Y[-#101-%s*#103-%s]", s3, s4);
        else if (w2 != 1.0 && w3 == 1.0)
          s.Format("Y[-%s*#101-#103-%s]", s2, s4);
        else s.Format("Y[-%s*#101-%s*#103-%s]", 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.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);
      }
      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 && w3 == 1.0)
          s.Format("Y[-#102+#103+%s]", s4);
        else if (w1 == 1.0 && w3 != 1.0)
          s.Format("Y[-#102+%s*#103+%s]", s3, s4);
        else if (w1 != 1.0 && w3 == 1.0)
          s.Format("Y[-%s*#102+#103+%s]", s1, s4);
        else s.Format("Y[-%s*#102+%s*#103+%s]", s1, 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 && w3 == 1.0)s = "Y[-#102+#103]";
        else if (w1 == 1.0 && w3 != 1.0)
          s.Format("Y[-#102+%s*#103]", s3);
        else if (w1 != 1.0 && w3 == 1.0)
          s.Format("Y[-%s*#102+#103]", s1);
        else s.Format("Y[-%s*#102+%s*#103]", s1, 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 && w3 == 1.0)
          s.Format("Y[-#102+#103-%s]", s4);
        else if (w1 == 1.0 && w3 != 1.0)
          s.Format("Y[-#102+%s*#103-%s]", s3, s4);
        else if (w1 != 1.0 && w3 == 1.0)
          s.Format("Y[-%s*#102+#103-%s]", s1, s4);
        else s.Format("Y[-%s*#102+%s*#103-%s]", s1, s3, s4);           
      }
未完待续。。。。。

时间都去哪了？

谢谢分享