|
|
(一).五轴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]
}
}
|
|