|
# 根据不同刀具类型,分别计算PO值
# if{![info exits mom_tool_radius]}{
if{$mom_tool_radius!=0}{
set PO(0) [expr $mom_pos(0)-$mom_contact_point(0)]
set PO(1) [expr $mom_pos(1)-$mom_contact_point(1)]
set PO(2) [expr $mom_pos(2)-$mom_contact_point(2)]
} else {
if{$mom_tool_radius == 0.5*$mom_tool_diameter}{
set PO(0) [expr $mom_contact_center(0)-$mom_contact_point(0)]
set PO(1) [expr $mom_contact_center(1)-$mom_contact_point(1)]
set PO(2) [expr $mom_contact_center(2)-$mom_contact_point(2)]
}
elseif{$mom_tool_radius != 0.5*$mom_tool_diameter}{
set PO(0) [expr $mom_pos(0)+$mom_tool_radius*$mom_tool_axis(0)-$mom_contact_point(0)]
set PO(1) [expr $mom_pos(1)+$mom_tool_radius*$mom_tool_axis(1)-$mom_contact_point(1)]
set PO(2) [expr $mom_pos(2)+$mom_tool_radius*$mom_tool_axis(2)-$mom_contact_point(2)]
}
}
本来想根据是否存在mom_tool_radius来判断是否是平底刀的,但是写的报警,所以根据mom_tool_radius!=0来判断。
现在的问题是,现在会出现一个1770001的报警,而且报警的内容没有反应到mom_information.out里面,请高手指教,问题出在哪儿,或者告诉我怎么判断道具是否地平底刀。
谢谢! |
|