|
|
set w3 [format "%.6f" $d3]
if {![string compare "-1.000000" $w3]} {
set s3 "-#102"
} elseif {![string compare "1.000000" $w3]} {
set s3 "+#102"
} else {
if {[string index $w3 end-0] == "0"} {
if {[string index $w3 end-1] == "0"} {
if {[string index $w3 end-2] == "0"} {
if {[string index $w3 end-3] == "0"} {
if {[string index $w3 end-4] == "0"} {
if {[string index $w3 end-5] == "0"} {
set w3 [format "%d." [expr round($d3)]]
} else {
set w3 [format "%.1f" $d3]
}
} else {
set w3 [format "%.2f" $d3]
}
} else {
set w3 [format "%.3f" $d3]
}
} else {
set w3 [format "%.4f" $d3]
}
} else {
set w3 [format "%.5f" $d3]
}
}
if {$d3 > 0.0} {
set s3 [format "+%s*#102" $w3]
} elseif {$d3 < 0.0} {
set s3 [format "%s*#102" $w3]
} else {
set s3 "NONE"
}
}
set w4 [format "%.4f" $vz]
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($vz)]]
} else {
set w4 [format "%.1f" $vz]
}
} else {
set w4 [format "%.2f" $vz]
}
} else {
set w4 [format "%.3f" $vz]
}
}
if {$vz > 0.0} {
set s4 [format "+%s" $w4]
} elseif {$vz < 0.0} {
set s4 [format "%s" $w4]
} else {
set s4 "NONE"
}
if {[string compare "NONE" $s1] && [string compare "NONE" $s2] && [string compare "NONE" $s3]} {
set s [format "%s%s%s" $s1 $s2 $s3]
} elseif {[string compare "NONE" $s1] && ![string compare "NONE" $s2] && ![string compare "NONE" $s3]} {
set s $s1
} elseif {![string compare "NONE" $s1] && [string compare "NONE" $s2] && ![string compare "NONE" $s3]} {
set s $s2
} elseif {![string compare "NONE" $s1] && ![string compare "NONE" $s2] && [string compare "NONE" $s3]} {
set s $s3
} elseif {[string compare "NONE" $s1] && [string compare "NONE" $s2] && ![string compare "NONE" $s3]} {
set s [format "%s%s" $s1 $s2]
} elseif {[string compare "NONE" $s1] && ![string compare "NONE" $s2] && [string compare "NONE" $s3]} {
set s [format "%s%s" $s1 $s3]
} elseif {![string compare "NONE" $s1] && [string compare "NONE" $s2] && [string compare "NONE" $s3]} {
set s [format "%s%s" $s2 $s3]
} else {
set s "NONE"
}
if {[string compare "NONE" $s] && [string compare "NONE" $s4]} {
set sz [format "\[%s%s\]" $s $s4]
} elseif {![string compare "NONE" $s] && [string compare "NONE" $s4]} {
set sz $s4
} elseif {[string compare "NONE" $s] && ![string compare "NONE" $s4]} {
set sz [format "\[%s\]" $s]
} else {
set sz "0."
}
return 1
}
return 0
点击确定。
(22).将"初始移动"事件下的G0 G90 G(54~59) 文本元素1 文本元素2 B C S M3行复制到"第一次移动"事件下的G0 G90 (54~59) X Y B C S M3行下面。
(23).在"初始移动"事件下的G0 G90 G(54~59) 文本元素1 文本元素2 B C S M3行下面添加G43 Z H1 M8行，
添加输出条件PB__CMD_check_block_initial_move2，编辑TCL代码如下：
global dpp_path_type
if {![string compare "3X" $dpp_path_type]} {
return 1
}
return 0
点击确定。
(24).将"初始移动"事件下的G43 Z H1 M8行复制到"第一次移动"事件下的G0 G90 (54~59) 文本元素1 文本元素2 X Y B C S M3行下面。
(25).在"初始移动"事件下的G43 Z H1 M8行下面添加G43 文本元素 H1 M8行，将文本元素内容改为Z$sz,
添加输出条件PB__CMD_check_block_initial_move3，编辑TCL代码如下：
global dpp_path_type
if {![string compare "5X" $dpp_path_type]} {
return 1
}
return 0
点击确定。
(26).将"初始移动"事件下的G43 文本元素 H1 M8行复制到"第一次移动"事件下的G43 Z H1 M8行下面。
7.在"程序和刀轨"选项卡中,选择左侧"运动"选项：
(1).将"圆周移动"事件下的G17 G2 G90 X Y Z I J K F S行中的G17和S元素删除，将G2元素设置为强制输出，
添加输出条件PB__CMD_check_block_circular_move，编辑TCL代码如下：
global dpp_path_type
if {![string compare "3X" $dpp_path_type]} {
return 1
}
return 0
点击确定。
(2).将"线性移动"事件下的G41 G17 G1 G90 X Y Z B C F S D1 M3 M8行中的G17,S,M3,M8元素删除，
添加输出条件PB__CMD_check_block_linear_move，编辑TCL代码如下：
global dpp_path_type
if {![string compare "3X" $dpp_path_type]} {
return 1
}
return 0
点击确定。
(3).在"线性移动"事件下的G41 G1 G90 X Y Z B C F D1行下面添加G41 G1 G90 文本元素 B C F D1行，
将文本元素内容改为X$sx Y$sy Z$sz，添加输出条件PB_CMD__check_block_linear_move_1，
编辑TCL代码如下：
global dpp_path_type
global e1 e2 e3 d1 d2 d3 vx vy vz rad_b rad_c
global w1 w2 w3 s s1 s2 s3 s4 sx sy sz
global mom_out_angle_pos mom_pos
if {![string compare "5X" $dpp_path_type]} {
set rad_b [expr $mom_out_angle_pos(0)*0.01745329252]
set rad_c [expr $mom_out_angle_pos(1)*0.01745329252]
#**********************计算Xrtcp*********************
set e1 [expr cos($rad_b)*cos($rad_c)-1.0]
set e2 [expr cos($rad_b)*sin($rad_c)]
set e3 [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 d3 [expr round($e3*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 "-#102"
} elseif {![string compare "1.000000" $w2]} {
set s2 "+#102"
} 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*#102" $w2]
} elseif {$d2 < 0.0} {
set s2 [format "%s*#102" $w2]
} else {
set s2 "NONE"
}
}
未完待续。。。。
|
|
发表于 