找回密码
 立即注册

QQ登录

只需一步,快速开始

微信扫码登录

搜索
查看: 46|回复: 0

[原创] 四轴五轴宏联动算法(九)

[复制链接]

29

主题

131

回帖

1505

积分

六级士官

积分
1505
发表于 9 小时前 | 显示全部楼层 |阅读模式
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);            
      }
      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)s.Format("Y[#102+%s]", s4);
        else s.Format("Y[%s*#102+%s]", s1, 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)s = "Y[#102]";
        else s.Format("Y[%s*#102]", s1);                                
      }
      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)s.Format("Y[#102-%s]", s4);
        else s.Format("Y[%s*#102-%s]", s1, 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);            
      }
      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);            
      }
未完待续。。。。。

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

咨询QQ:1359218528|发帖须知!|Archiver|手机版|小黑屋|UG爱好者论坛 ( 京ICP备10217105号-2 )

GMT+8, 2025-12-23 12:59

Powered by Discuz! X3.5 Licensed

© 2001-2025 Discuz! Team.

快速回复 返回顶部 返回列表