论坛 › NX1847~2512系列 › 四轴五轴宏联动算法(四)

Tualar 发表于 2025-12-21 22:41:45

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

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

18858528235 发表于 2025-12-22 08:39:41

牛逼虽然我用MC但是还是赞一波

blackluna 发表于 2025-12-22 09:31:06

谢谢分享

时间都去哪了？ 发表于 2025-12-22 18:58:14

谢谢分享

hegaoj3 发表于 2026-1-2 23:14:06

谢谢分享

查看完整版本: 四轴五轴宏联动算法(四)