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

Tualar

  # 计算Zrtcp=(cos4-1)*Zofs+sin4*cos5*Xofs+sin4*sin5*Yofs+Z
  set e1 [expr (cos($rb)-1.0)*$Zofs]
  set e2 [expr sin($rb)*cos($rc)*$Xofs]
  set e3 [expr sin($rb)*sin($rc)*$Yofs]
  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
(三).立加四轴A转台：
1.定轴加工-----加工原点G54计算TCL代码：
global dpp_path_type
global mom_out_angle_pos
global e1 e2 ra
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_output_literal "(刀路: 定轴)"
      set ra [expr $mom_out_angle_pos(0)*0.01745329252]
   } else {
       MOM_output_literal "(刀路: 三轴)"
       set ra 0.0
     }
} elseif {![string compare "4X" $dpp_path_type]} {
     MOM_output_literal "(刀路: 四轴联动)"
     set ra 0.0
  }

set sx [format "%.4f" $G56X]
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 $Yofs*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*$Yofs*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]
    }
}
2.联动加工-----刀尖跟随RTCP计算TCL代码：
global dpp_path_type
global mom_out_angle_pos
global mom_pos
global e1 e2 e3 ra
global vx vy vz
global sx sy sz
global Xofs Yofs Zofs
global G55X G55Y G55Z
global G56X G56Y G56Z

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

  # 计算Xrtcp=X
  set vx [expr round($mom_pos(0)*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-1)*Yofs+sin4*Zofs+Y
  set e1 [expr (cos($ra)-1.0)*$Yofs]
  set e2 [expr sin($ra)*$Zofs]
  set e3 $mom_pos(1)
  set vy [expr round(($e1+$e2+$e3)*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*Yofs+(cos4-1)*Zofs+Z
  set e1 [expr -1.0*sin($ra)*$Yofs]
  set e2 [expr (cos($ra)-1.0)*$Zofs]
  set e3 $mom_pos(2)
  set vz [expr round(($e1+$e2+$e3)*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
(四).卧加四轴B转台：
1.定轴加工-----加工原点G54计算TCL代码：
global dpp_path_type
global mom_out_angle_pos
global e1 e2 rb
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_output_literal "(刀路: 定轴)"
      set rb [expr $mom_out_angle_pos(0)*0.01745329252]
   } else {
       MOM_output_literal "(刀路: 三轴)"
       set rb 0.0
     }
} elseif {![string compare "4X" $dpp_path_type]} {
     MOM_output_literal "(刀路: 四轴联动)"
     set rb 0.0
  }

set e1 [expr $Xofs*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 sy [format "%.4f" $G56Y]
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 $Xofs*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 rb
global vx vy vz
global sx sy sz
global Xofs Yofs Zofs
global G55X G55Y G55Z
global G56X G56Y G56Z

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

  # 计算Xrtcp=(cos4-1)*Xofs-sin4*Zofs+X
  set e1 [expr (cos($rb)-1.0)*$Xofs]
  set e2 [expr sin($rb)*$Zofs]
  set e3 $mom_pos(0)
  set vx [expr round(($e1-$e2+$e3)*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=Y
  set vy [expr round($mom_pos(1)*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=(cos4-1)*Zofs+sin4*Xofs+Z
  set e1 [expr (cos($rb)-1.0)*$Zofs]
  set e2 [expr sin($rb)*$Xofs]
  set e3 $mom_pos(2)
  set vz [expr round(($e1+$e2+$e3)*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

冯大师专用

这是一个不错的分享

67240999

大神能分享个最后更新版本？BC轴