设置位置控制数据表
如果触发器EN为TRUE,该FP指令将根据s3_Table中设置的位置控制数据表,开始对s1_Slot指定的插槽位置控制单元和s2_Axis指定的轴进行位置控制。在Configurator PM7中配置位置控制数据表。
输入
插槽编号
轴编号
值:1–4, 8(虚拟轴)
位置控制数据表的编号
值: 1–600, 10001–10025
如果使用索引寄存器指定的区域超出限制。
如果插槽和/或轴编号超出范围
如果使用索引寄存器指定的区域超出限制。
如果插槽和/或轴编号超出范围
在全局变量列表中,定义项目中所有POU都可以访问的变量。
输入
输出
将DUT复制到剪贴板并将DUT直接粘贴到导航栏的DUT池,以便在程序中使用此DUT。
所有用于编程此函数的输入和输出变量已在POU头中声明。 所有编程语言使用相同的POU头。
当变量bStart从FALSE变为TRUE时,执行此函数。
VAR_EXTERNAL
g_dutPositioningInputs: FP_POS_UNIT_INPUT_DUT;
g_dutPositioningOutputs: FP_POS_UNIT_OUTPUT_DUT;
END_VAR
VAR_EXTERNAL CONSTANT
g_iPositioningUnitSlotNumber: INT:=1;
g_iPositioningUnitAxisNumber: INT:=1;
END_VAR
VAR
bAxisReady: BOOL:=FALSE;
bStartPositioning: BOOL:=FALSE;
iTableNumber: INT:=1;
@'': @'';
END_VAR
BODY
WORKSPACE
NETWORK_LIST_TYPE := NWTYPELD ;
ACTIVE_NETWORK := 0 ;
END_WORKSPACE
NET_WORK
NETWORK_TYPE := NWTYPELD ;
NETWORK_LABEL := ;
NETWORK_TITLE := ;
NETWORK_HEIGHT := 5 ;
NETWORK_BODY
B(B_VARIN,,g_dutPositioningInputs.b00_ReadyPositioning,21,1,23,3,);
B(B_VARIN,,g_dutPositioningInputs.b04_ToolOperation,21,2,23,4,);
B(B_F,@AND-3!,,28,1,33,5,,?D?D?D?C);
B(B_VARIN,,g_dutPositioningInputs.b60_ErrorAxis1,21,3,23,5,);
B(B_F,NOT!,,23,2,28,4,,?D?C);
B(B_F,NOT!,,23,3,28,5,,?D?C);
B(B_COIL,,bAxisReady,43,1,45,3,);
L(23,2,28,2);
L(33,2,43,2);
L(1,0,1,5);
END_NETWORK_BODY
END_NET_WORK
NET_WORK
NETWORK_TYPE := NWTYPELD ;
NETWORK_LABEL := ;
NETWORK_TITLE := ;
NETWORK_HEIGHT := 6 ;
NETWORK_BODY
B(B_CONTACT,,bStartPositioning,5,1,7,3,R);
B(B_F,FP_POS_UNIT_SET_TABLE!,,25,0,38,6,,?DEN?Ds1_Slot?Ds2_Axis?Ds3_Table?AENO);
B(B_VARIN,,g_iPositioningUnitSlotNumber,23,2,25,4,);
B(B_VARIN,,g_iPositioningUnitAxisNumber,23,3,25,5,);
B(B_VARIN,,iTableNumber,23,4,25,6,);
L(1,2,5,2);
L(7,2,25,2);
L(1,0,1,6);
END_NETWORK_BODY
END_NET_WORK
NET_WORK
NETWORK_TYPE := NWTYPELD ;
NETWORK_LABEL := ;
NETWORK_TITLE := ;
NETWORK_HEIGHT := 5 ;
NETWORK_BODY
B(B_VARIN,,bStartPositioning,21,1,23,3,);
B(B_VARIN,,bAxisReady,21,2,23,4,);
B(B_F,@AND-3!,,28,1,33,5,,?D?D?D?C);
B(B_VARIN,,g_dutPositioningInputs.b18_BusyAxis1,21,3,23,5,);
B(B_F,NOT!,,23,3,28,5,,?D?C);
B(B_COIL,,g_dutPositioningOutputs.b10_PositioningStartAxis1,43,1,45,3,);
B(B_F,DF!,,23,0,28,3,,?Di?Co);
L(23,3,28,3);
L(33,2,43,2);
L(1,0,1,5);
END_NETWORK_BODY
END_NET_WORK
END_BODY
If (g_dutPositioningInputs.b00_ReadyPositioning AND NOT g_dutPositioningInputs.b04_ToolOperation
AND NOT g_dutPositioningInputs.b60_ErrorAxis1) then
bAxisReady:=TRUE;
End_if;
If (bStart) then
FP_POS_UNIT_SET_TABLE(s1_Slot := g_iPositioningUnitSlotNumber,
s2_Axis := g_iPositioningUnitAxisNumber,
s3_Table := iTableNumber);
End_if;
If DF((bStart) AND bAxisReady Then AND NOT g_dutPositioningInputs.b18_BusyAxis1) then
g_dutPositioningOutputs.b10_PositioningStartAxis1:=TRUE;
End_if;