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

Tualar 发表于 2025-12-24 06:42:29

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

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

时间都去哪了？ 发表于 2025-12-24 09:55:06

谢谢分享

hegaoj3 发表于 2026-1-3 00:02:20

谢谢分享

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