找回密码
 立即注册

QQ登录

只需一步,快速开始

微信扫码登录

搜索
查看: 32|回复: 0

[原创] 在UG后处理中直接计算RTCP,避免宏联动卡顿的方法(一)

[复制链接]

54

主题

138

回帖

1657

积分

六级士官

积分
1657
发表于 3 小时前 | 显示全部楼层 |阅读模式
(一).五轴AC双转台:
1.程序起始序列中添加定制命令PB_CMD_global_var,编辑TCL代码如下:
global dpp_path_type
global dpp_flag
set dpp_flag 0
set dpp_path_type "NONE"
# 旋转中心点G55X,G55Y,G55Z
global G55X G55Y G55Z
set G55X 570.8367
set G55Y -220.6426
set G55Z -475.0
# 编程原点G56X,G56Y,G56Z
global G56X G56Y G56Z
set G56X 580.8367
set G56Y -210.6426
set G56Z -219.0
# 编程原点相对于旋转中心点偏移
global Xofs Yofs Zofs
set Xofs [expr $G56X-$G55X]
set Yofs [expr $G56Y-$G55Y]
set Zofs [expr $G56Z-$G55Z]

2.定轴加工-----加工原点G54计算TCL代码:
global dpp_path_type
global mom_out_angle_pos
global v e1 e2 ra rc
global vx vy vz
global sx sy sz
global Xofs Yofs Zofs
global G55X G55Y G55Z
global G56X G56Y G56Z

if {![string compare "3X" $dpp_path_type]} {
  if { $mom_out_angle_pos(0) !=0 || $mom_out_angle_pos(1) != 0} {
    MOM_output_literal "(刀路: 定轴)"
    set ra [expr $mom_out_angle_pos(0)*0.01745329252]
    set rc [expr $mom_out_angle_pos(1)*0.01745329252]
  } else {
      MOM_output_literal "(刀路: 三轴)"
      set ra 0.0
      set rc 0.0
    }
} elseif {![string compare "5X" $dpp_path_type]} {
    MOM_output_literal "(刀路: 五轴联动)"
    set ra 0.0
    set rc 0.0
  }

set e1 [expr -1.0*$Xofs*sin($rc)]
set e2 [expr $Yofs*cos($rc)]
set v  [expr $e1+$e2]

set e1 [expr $Xofs*cos($rc)]
set e2 [expr $Yofs*sin($rc)]
set vx [expr round(($e1+$e2+$G55X)*10000.0)/10000.0]
set sx [format "%.4f" $vx]
if {[string index $sx end-0] == "0"} {
  if {[string index $sx end-1] == "0"} {
    if {[string index $sx end-2] == "0"} {
      if {[string index $sx end-3] == "0"} {
        set sx [format "%d." [expr round($vx)]]
      } else {
          set sx [format "%.1f" $vx)]
        }
    } else {
        set sx [format "%.2f" $vx]
      }
  } else {
      set sx [format "%.3f" $vx]
    }
}

set e1 [expr $v*cos($ra)]
set e2 [expr $Zofs*sin($ra)]
set vy [expr round(($e1+$e2+$G55Y)*10000.0)/10000.0]
set sy [format "%.4f" $vy]
if {[string index $sy end-0] == "0"} {
  if {[string index $sy end-1] == "0"} {
    if {[string index $sy end-2] == "0"} {
      if {[string index $sy end-3] == "0"} {
        set sy [format "%d." [expr round($vy)]]
      } else {
          set sy [format "%.1f" $vy)]
        }
    } else {
        set sy [format "%.2f" $vy]
      }
  } else {
      set sy [format "%.3f" $vy]
    }
}

set e1 [expr -1.0*$v*sin($ra)]
set e2 [expr $Zofs*cos($ra)]
set vz [expr round(($e1+$e2+$G55Z)*10000.0)/10000.0]
set sz [format "%.4f" $vz]
if {[string index $sz end-0] == "0"} {
  if {[string index $sz end-1] == "0"} {
    if {[string index $sz end-2] == "0"} {
      if {[string index $sz end-3] == "0"} {
        set sz [format "%d." [expr round($vz)]]
      } else {
          set sz [format "%.1f" $vz)]
        }
    } else {
        set sz [format "%.2f" $vz]
      }
  } else {
      set sz [format "%.3f" $vz]
    }
}
3.联动加工-----刀尖跟随RTCP计算TCL代码:
global dpp_path_type
global mom_out_angle_pos
global mom_pos
global e1 e2 e3 e4 ra rc
global vx vy vz
global sx sy sz
global Xofs Yofs Zofs
global G55X G55Y G55Z
global G56X G56Y G56Z

if {![string compare "5X" $dpp_path_type]} {
  set ra [expr $mom_out_angle_pos(0)*0.01745329252]
  set rc [expr $mom_out_angle_pos(1)*0.01745329252]

  # 计算Xrtcp=(cos5-1)*Xofs+sin5*Yofs+X
  set e1 [expr (cos($rc)-1.0)*$Xofs]
  set e2 [expr sin($rc)*$Yofs]
  set e4 $mom_pos(0)
  set vx [expr round(($e1+$e2+$e4)*10000.0)/10000.0]
  set sx [format "%.4f" $vx]
  if {[string index $sx end-0] == "0"} {
    if {[string index $sx end-1] == "0"} {
      if {[string index $sx end-2] == "0"} {
        if {[string index $sx end-3] == "0"} {
          set sx [format "%d." [expr round($vx)]]
        } else {
            set sx [format "%.1f" $vx)]
          }
      } else {
          set sx [format "%.2f" $vx]
        }
    } else {
        set sx [format "%.3f" $vx]
      }
  }

  # 计算Yrtcp=(cos4*cos5-1)*Yofs-cos4*sin5*Xofs+sin4*Zofs+Y
  set e1 [expr (cos($ra)*cos($rc)-1.0)*$Yofs]
  set e2 [expr cos($ra)*sin($rc)*$Xofs]
  set e3 [expr sin($ra)*$Zofs]
  set e4 $mom_pos(1)
  set vy [expr round(($e1-$e2+$e3+$e4)*10000.0)/10000.0]
  set sy [format "%.4f" $vy]
  if {[string index $sy end-0] == "0"} {
    if {[string index $sy end-1] == "0"} {
      if {[string index $sy end-2] == "0"} {
        if {[string index $sy end-3] == "0"} {
          set sy [format "%d." [expr round($vy)]]
        } else {
            set sy [format "%.1f" $vy)]
          }
      } else {
          set sy [format "%.2f" $vy]
        }
    } else {
        set sy [format "%.3f" $vy]
      }
  }

  # 计算Zrtcp=sin4*sin5*Xofs-sin4*cos5*Yofs+(cos4-1)*Zofs+Z
  set e1 [expr sin($ra)*sin($rc)*$Xofs]
  set e2 [expr sin($ra)*cos($rc)*$Yofs]
  set e3 [expr (cos($ra)-1.0)*$Zofs]
  set e4 $mom_pos(2)
  set vz [expr round(($e1-$e2+$e3+$e4)*10000.0)/10000.0]
  set sz [format "%.4f" $vz]
  if {[string index $sz end-0] == "0"} {
    if {[string index $sz end-1] == "0"} {
      if {[string index $sz end-2] == "0"} {
        if {[string index $sz end-3] == "0"} {
          set sz [format "%d." [expr round($vz)]]
        } else {
            set sz [format "%.1f" $vz)]
          }
      } else {
          set sz [format "%.2f" $vz]
        }
    } else {
        set sz [format "%.3f" $vz]
      }
  }
  return 1
}
return 0
(二).五轴BC双转台:
1.定轴加工-----加工原点G54计算TCL代码:
global dpp_path_type
global mom_out_angle_pos
global v e1 e2 rb rc
global vx vy vz
global sx sy sz
global Xofs Yofs Zofs
global G55X G55Y G55Z
global G56X G56Y G56Z

if {![string compare "3X" $dpp_path_type]} {
   if { $mom_out_angle_pos(0) !=0 || $mom_out_angle_pos(1) != 0} {
      MOM_output_literal "(刀路: 定轴)"
      set rb [expr $mom_out_angle_pos(0)*0.01745329252]
      set rc [expr $mom_out_angle_pos(1)*0.01745329252]
   } else {
       MOM_output_literal "(刀路: 三轴)"
       set rb 0.0
       set rc 0.0
     }
} elseif {![string compare "5X" $dpp_path_type]} {
     MOM_output_literal "(刀路: 五轴联动)"
     set rb 0.0
     set rc 0.0
  }

set e1 [expr $Xofs*cos($rc)]
set e2 [expr $Yofs*sin($rc)]
set v  [expr $e1+$e2]

set e1 [expr $v*cos($rb)]
set e2 [expr $Zofs*sin($rb)]
set vx [expr round(($e1-$e2+$G55X)*10000.0)/10000.0]
set sx [format "%.4f" $vx]
if {[string index $sx end-0] == "0"} {
  if {[string index $sx end-1] == "0"} {
    if {[string index $sx end-2] == "0"} {
      if {[string index $sx end-3] == "0"} {
        set sx [format "%d." [expr round($vx)]]
      } else {
          set sx [format "%.1f" $vx)]
        }
    } else {
        set sx [format "%.2f" $vx]
      }
  } else {
      set sx [format "%.3f" $vx]
    }
}

set e1 [expr -1.0*$Xofs*sin($rc)]
set e2 [expr $Yofs*cos($rc)]
set vy [expr round(($e1+$e2+$G55Y)*10000.0)/10000.0]
set sy [format "%.4f" $vy]
if {[string index $sy end-0] == "0"} {
  if {[string index $sy end-1] == "0"} {
    if {[string index $sy end-2] == "0"} {
      if {[string index $sy end-3] == "0"} {
        set sy [format "%d." [expr round($vy)]]
      } else {
          set sy [format "%.1f" $vy)]
        }
    } else {
        set sy [format "%.2f" $vy]
      }
  } else {
      set sy [format "%.3f" $vy]
    }
}

set e1 [expr $Zofs*cos($rb)]
set e2 [expr $v*sin($rb)]
set vz [expr round(($e1+$e2+$G55Z)*10000.0)/10000.0]
set sz [format "%.4f" $vz]
if {[string index $sz end-0] == "0"} {
  if {[string index $sz end-1] == "0"} {
    if {[string index $sz end-2] == "0"} {
      if {[string index $sz end-3] == "0"} {
        set sz [format "%d." [expr round($vz)]]
      } else {
          set sz [format "%.1f" $vz)]
        }
    } else {
        set sz [format "%.2f" $vz]
      }
  } else {
      set sz [format "%.3f" $vz]
    }
}
2.联动加工-----刀尖跟随RTCP计算TCL代码:
global dpp_path_type
global mom_out_angle_pos
global mom_pos
global e1 e2 e3 e4 rb rc
global vx vy vz
global sx sy sz
global Xofs Yofs Zofs
global G55X G55Y G55Z
global G56X G56Y G56Z

if {![string compare "5X" $dpp_path_type]} {
  set rb [expr $mom_out_angle_pos(0)*0.01745329252]
  set rc [expr $mom_out_angle_pos(1)*0.01745329252]

  # 计算Xrtcp=(cos4*cos5-1)*Xofs+cos4*sin5*Yofs-sin4*Zofs+X
  set e1 [expr (cos($rb)*cos($rc)-1.0)*$Xofs]
  set e2 [expr cos($rb)*sin($rc)*$Yofs]
  set e3 [expr sin($rb)*$Zofs]
  set e4 $mom_pos(0)
  set vx [expr round(($e1+$e2-$e3+$e4)*10000.0)/10000.0]
  set sx [format "%.4f" $vx]
  if {[string index $sx end-0] == "0"} {
    if {[string index $sx end-1] == "0"} {
      if {[string index $sx end-2] == "0"} {
        if {[string index $sx end-3] == "0"} {
          set sx [format "%d." [expr round($vx)]]
        } else {
            set sx [format "%.1f" $vx)]
          }
      } else {
          set sx [format "%.2f" $vx]
        }
    } else {
        set sx [format "%.3f" $vx]
      }
  }

  # 计算Yrtcp=-sin5*Xofs+(cos5-1)*Yofs+Y
  set e1 [expr -1.0*sin($rc)*$Xofs]
  set e2 [expr (cos($rc)-1.0)*$Yofs]
  set e4 $mom_pos(1)
  set vy [expr round(($e1+$e2+$e4)*10000.0)/10000.0]
  set sy [format "%.4f" $vy]
  if {[string index $sy end-0] == "0"} {
    if {[string index $sy end-1] == "0"} {
      if {[string index $sy end-2] == "0"} {
        if {[string index $sy end-3] == "0"} {
          set sy [format "%d." [expr round($vy)]]
        } else {
            set sy [format "%.1f" $vy)]
          }
      } else {
          set sy [format "%.2f" $vy]
        }
    } else {
        set sy [format "%.3f" $vy]
      }
  }


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

本版积分规则

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

GMT+8, 2026-1-26 10:53

Powered by Discuz! X3.5 Licensed

© 2001-2025 Discuz! Team.

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