版权声明：本文为博主原创文章，未经博主允许不得转载。 https://blog.csdn.net/itworld123/article/details/83786293
---------------------------------------------
-- 时间：2018-11-04
-- 创建人：Ruo_Xiao
-- 邮箱：[email protected]
---------------------------------------------一、得到指定TOOL下的机器人当前位置
ROUTINE IF_GetCurPos (iTool : INTEGER) : XYZWPREXT
BEGIN
-------------CURRENT USER FRAME-------------
--$GROUP[1].$UFRAME = $MNUFRAME[1,$MNUFRAMENUM[1]]
--$GROUP[1].$UTOOL = $MOR_GRP[1].$NILPOS
--$GROUP[1].$UTOOL = $MNUTOOL[1,$MNUTOOLNUM[1]]
--$GROUP[1].$UTOOL = $MOR_GRP[1].$NILPOS
IF iTool < 1 THEN
$GROUP[1].$UTOOL = $MNUTOOL[1,$MNUTOOLNUM[1]]
ELSE
IF iTool >=1 THEN
$GROUP[1].$UTOOL = $MNUTOOL[1 , iTool]
ENDIF
ENDIF
RETURN (CURPOS(0,0) )
END IF_GetCurPos二、得到或者设置TOOL的数据
---------------------------- Set Tool Data -----------------------------
-- 作用：得到或者设置制定tool的数据
-- 输入：iToolNum tool编号
-- Pos_Tool 得到或者待设置的TOOL的数据
-- iMode 1 得到
-- 2 设置
-- iStatus 结果
-- 输出：无
ROUTINE IF_GSToolDa (iToolNum : INTEGER ; Pos_Tool : POSITION ; iMode , iStatus : INTEGER)
VAR
iEntry : INTEGER
BEGIN
iEntry = 0
IF iMode=1 THEN
GET_VAR(iEntry , '*SYSTEM*' , '$MNUTOOL[1,iToolNum]',Pos_Tool , iStatus)
ELSE
IF iMode=2 THEN
SET_VAR(iEntry , '*SYSTEM*' , '$MNUTOOL[1,iToolNum]',Pos_Tool , iStatus)
ENDIF
ENDIF
END IF_GSToolDa（未完待续！）
（SAW：Game Over！）