找回密码
 立即注册

QQ登录

只需一步,快速开始

微信扫码登录

搜索
查看: 297|回复: 4

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

[复制链接]

54

主题

138

回帖

1661

积分

六级士官

积分
1661
发表于 2025-12-21 22:44:22 | 显示全部楼层 |阅读模式
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);
        else s.Format("X[%s*#102-%s*#103]", 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 (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 (w3 == 1.0)s.Format("X[#103+%s]", s4);
        else s.Format("X[%s*#103+%s]", 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 (w3 == 1.0)s = "X[#103]";
        else s.Format("X[%s*#103]", s3);
      }
      else if (v1 == 0.0 && v2 == 0.0 && v3 > 0.0 && x < 0.0)
      { //v1=0,v2=0,v3>0,x<0
        if (w3 == 1.0)s.Format("X[#103-%s]", s4);
        else s.Format("X[%s*#103-%s]", s3, s4);
      }
      else if (v1 == 0.0 && v2 == 0.0 && v3 == 0.0 && x > 0.0)
        s.Format("X%s", s4);     //v1=0,v2=0,v3=0,x>0
      else if (v1 == 0.0 && v2 == 0.0 && v3 == 0.0 && x == 0.0)
        s = "X0.";               //v1=0,v2=0,v3=0,x=0
      else if (v1 == 0.0 && v2 == 0.0 && v3 == 0.0 && x < 0.0)
        s.Format("X-%s", s4);    //v1=0,v2=0,v3=0,x<0
      else if (v1 == 0.0 && v2 == 0.0 && v3 < 0.0 && x > 0.0)
      { //v1=0,v2=0,v3<0,x>0
        if (w3 == 1.0)s.Format("X[-#103+%s]", s4);
        else s.Format("X[-%s*#103+%s]", 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 (w3 == 1.0)s = "X[-#103]";
        else s.Format("X[-%s*#103]", s3);
      }
      else if (v1 == 0.0 && v2 == 0.0 && v3 < 0.0 && x < 0.0)
      { //v1=0,v2=0,v3<0,x<0
        if (w3 == 1.0)s.Format("X[-#103-%s]", s4);
        else s.Format("X[-%s*#103-%s]", 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);
        else s.Format("X[-%s*#102+%s*#103]", 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 (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);
      }
      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);
        else s.Format("X[-%s*#102-%s*#103]", 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 (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 (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]", s1, s2, s3);
        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);
      }
未完待续。。。。。。。。

评分

参与人数 1G币 +10 收起 理由
3079872616 + 10 很给力!

查看全部评分

0

主题

584

回帖

1880

积分

六级士官

积分
1880
发表于 2025-12-22 09:30:19 | 显示全部楼层
谢谢分享

5

主题

718

回帖

1633

积分

六级士官

积分
1633
发表于 2025-12-22 18:57:56 来自手机 | 显示全部楼层
谢谢分享

0

主题

734

回帖

5109

积分

上尉

积分
5109
发表于 2025-12-25 10:12:05 | 显示全部楼层
谢谢分享

2

主题

1959

回帖

8941

积分

少校

积分
8941
发表于 2026-1-2 23:14:50 | 显示全部楼层
谢谢分享
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

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

GMT+8, 2026-2-7 18:32

Powered by Discuz! X3.5 Licensed

© 2001-2025 Discuz! Team.

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