|
|
(16).将PB_CMD_detect_tool_path_type行复制到"第一次移动"事件下。
(17).在"初始移动"事件下的PB_CMD_detect_tool_path_type行下面添加定制命令，
输入名称PB_CMD_calc_g54，编辑TCL代码如下：
global dpp_path_type
global mom_out_angle_pos
global vb
global sb
if {![string compare "3X" $dpp_path_type]} {
if { $mom_out_angle_pos(0) !=0 } {
MOM_output_literal "(刀路: 定轴)"
#*******************获取第四轴B旋转角度**********************
set vb [expr round($mom_out_angle_pos(0)*10000.0)/10000.0]
#将A轴角度转换成字符串，并且去除小数末尾多余0
set sb [format "%.4f" $vb]
if {[string index $sb end-0] == "0"} {
if {[string index $sb end-1] == "0"} {
if {[string index $sb end-2] == "0"} {
if {[string index $sb end-3] == "0"} {
set sb [format "%d." [expr round($vb)]]
} else {
set sb [format "%.1f" $vb)]
}
} else {
set sb [format "%.2f" $vb]
}
} else {
set sb [format "%.3f" $vb]
}
}
#**********************计算3+1定轴加工原点G54************************
MOM_output_literal "#130=$sb"
MOM_output_literal "#24=#101*COS\[#130\]-#103*SIN\[#130\]+#5241"
MOM_output_literal "#25=#5262"
MOM_output_literal "#26=#103*COS\[#130\]+#101*SIN\[#130\]+#5243"
MOM_output_literal "G90 G10 L2 P1 X\[#24\] Y\[#25\] Z\[#26\]"
} else {
MOM_output_literal "(刀路: 三轴)"
#**********************计算三轴加工原点G54************************
MOM_output_literal "#130=0."
MOM_output_literal "#24=#101*COS\[#130\]-#103*SIN\[#130\]+#5241"
MOM_output_literal "#25=#5262"
MOM_output_literal "#26=#103*COS\[#130\]+#101*SIN\[#130\]+#5243"
MOM_output_literal "G90 G10 L2 P1 X\[#24\] Y\[#25\] Z\[#26\]"
}
} elseif {![string compare "5X" $dpp_path_type]} {
MOM_output_literal "(刀路: 四轴联动)"
#*******计算四轴联动加工原点G54，让加工原点G54与编程原点G56重合*******
MOM_output_literal "#130=0."
MOM_output_literal "#24=#101*COS\[#130\]-#103*SIN\[#130\]+#5241"
MOM_output_literal "#25=#5262"
MOM_output_literal "#26=#103*COS\[#130\]+#101*SIN\[#130\]+#5243"
MOM_output_literal "G90 G10 L2 P1 X\[#24\] Y\[#25\] Z\[#26\]"
}
点击确定。
(18).将PB_CMD_calc_g54行复制到"第一次移动"事件下的PB_CMD_detect_tool_path_type行下面。
(19).在"初始移动"事件下的PB_CMD_calc_g54行下面添加G0 G90 G(54~59) X Y B S M3行,
添加输出条件PB__CMD_check_block_initial_move，编辑TCL代码如下:
global dpp_path_type
if {![string compare "3X" $dpp_path_type]} {
return 1
}
return 0
点击确定。
(20).将"初始移动"事件下的G0 G90 G(54~59) X Y B S M3行复制到"第一次移动"事件下的PB_CMD_calc_g54行下面。
(21).在"初始移动"事件下的G0 G90 G(54~59) X Y B S M3行下面添加G0 G90 G(54~59) 文本元素1 文本元素2 B S M3行,
将文本元素1内容改成X$sx，将文本元素改成Y$sy，
添加输出条件PB__CMD_check_block_initial_move_1，编辑TCL代码如下:
global dpp_path_type
global e1 e2 d1 d2 vx vy vz rad_b
global wi w2 w4 s s1 s2 s4 sx sy sz
global mom_pos mom_out_angle_pos
if {![string compare "4X" $dpp_path_type]} {
set rad_b [expr $mom_out_angle_pos(0)*0.01745329252]
#*********************计算Xrtcp***********************
set e1 [expr cos($rad_b)-1.0]
set e2 [expr -1.0*sin($rad_b)]
set d1 [expr round($e1*1000000.0)/1000000.0]
set d2 [expr round($e2*1000000.0)/1000000.0]
set vx [expr round($mom_pos(0)*10000.0)/10000.0]
set w1 [format "%.6f" $d1]
if {![string compare "-1.000000" $w1]} {
set s1 "-#101"
} elseif {![string compare "1.000000" $w1]} {
set s1 "#101"
} else {
if {[string index $w1 end-0] == "0"} {
if {[string index $w1 end-1] == "0"} {
if {[string index $w1 end-2] == "0"} {
if {[string index $w1 end-3] == "0"} {
if {[string index $w1 end-4] == "0"} {
if {[string index $w1 end-5] == "0"} {
set w1 [format "%d." [expr round($d1)]]
} else {
set w1 [format "%.1f" $d1]
}
} else {
set w1 [format "%.2f" $d1]
}
} else {
set w1 [format "%.3f" $d1]
}
} else {
set w1 [format "%.4f" $d1]
}
} else {
set w1 [format "%.5f" $d1]
}
}
if {$d1 != 0.0} {
set s1 [format "%s*#101" $w1]
} else {
set s1 "NONE"
}
}
set w2 [format "%.6f" $d2]
if {![string compare "-1.000000" $w2]} {
set s2 "-#103"
} elseif {![string compare "1.000000" $w2]} {
set s2 "+#103"
} else {
if {[string index $w2 end-0] == "0"} {
if {[string index $w2 end-1] == "0"} {
if {[string index $w2 end-2] == "0"} {
if {[string index $w2 end-3] == "0"} {
if {[string index $w2 end-4] == "0"} {
if {[string index $w2 end-5] == "0"} {
set w2 [format "%d." [expr round($d2)]]
} else {
set w2 [format "%.1f" $d2]
}
} else {
set w2 [format "%.2f" $d2]
}
} else {
set w2 [format "%.3f" $d2]
}
} else {
set w2 [format "%.4f" $d2]
}
} else {
set w2 [format "%.5f" $d2]
}
}
if {$d2 > 0.0} {
set s2 [format "+%s*#103" $w2]
} elseif {$d2 < 0.0} {
set s2 [format "%s*#103" $w2]
} else {
set s2 "NONE"
}
}
set w4 [format "%.4f" $vx]
if {[string index $w4 end-0] == "0"} {
if {[string index $w4 end-1] == "0"} {
if {[string index $w4 end-2] == "0"} {
if {[string index $w4 end-3] == "0"} {
set w4 [format "%d." [expr round($vx)]]
} else {
set w4 [format "%.1f" $vx]
}
} else {
set w4 [format "%.2f" $vx]
}
} else {
set w4 [format "%.3f" $vx]
}
}
if {$vx > 0.0} {
set s4 [format "+%s" $w4]
} elseif {$vx < 0.0} {
set s4 [format "%s" $w4]
} else {
set s4 "NONE"
}
if {[string compare "NONE" $s1] && ![string compare "NONE" $s2]} {
set s $s1
} elseif {![string compare "NONE" $s1] && [string compare "NONE" $s2]} {
set s $s2
} elseif {[string compare "NONE" $s1] && [string compare "NONE" $s2]} {
set s [format "%s%s" $s1 $s2]
} else {
set s "NONE"
}
if {[string compare "NONE" $s] && [string compare "NONE" $s4]} {
set sx [format "\[%s%s\]" $s $s4]
} elseif {![string compare "NONE" $s] && [string compare "NONE" $s4]} {
set sx $s4
} elseif {[string compare "NONE" $s] && ![string compare "NONE" $s4]} {
set sx [format "\[%s\]" $s]
} else {
set sx "0."
}
#*********************计算Yrtcp***********************
set vy [expr round($mom_pos(1)*10000.0)/10000.0]
set w4 [format "%.4f" $vy]
if {[string index $w4 end-0] == "0"} {
if {[string index $w4 end-1] == "0"} {
if {[string index $w4 end-2] == "0"} {
if {[string index $w4 end-3] == "0"} {
set w4 [format "%d." [expr round($vy)]]
} else {
set w4 [format "%.1f" $vy]
}
} else {
set w4 [format "%.2f" $vy]
}
} else {
set w4 [format "%.3f" $vy]
}
}
set sy $w4
未完待续。。。。。
|
|
发表于 
