SEQ338 P01 : Programme Choice 3 process pallet sector 2

[hit  <- on your browser to return]

 

 

 

Network 1: Call actual SSM

#SSM(STEP_PLS := "HMI KEY".P01.GLB.F17_StepPls,

     STEP_MNS := "HMI KEY".P01.GLB.F18_StepMns,

     GOTO_STEP := FALSE,

     GOTO_STEP_NO := 0,

     LAST_STEP := 12);

 IF "DI MAIN GLB".M00.CmpltMaOFF_Imp THEN

     #SSM.S.stepin := FALSE;

 END_IF;

 "DI MAIN P01".SEQ1.SSM.S.stepin := #SSM.S.stepin;

 

 

 

Network 2: Pre-Setting

"DI MAIN P01".SEQ1.Support.stepd := #SSM.S.stepd;

 

 

 

Network 3: CASE-Function corresponds to actual SSM

CASE #SSM.S.stepact OF

    0: // Waiting for SEQ to start

        "DI MAIN P01".to_P02_Pallet.Request := #SSM.S.stepa AND NOT #Done;

        #SSM.S.stepd := #SSM.S.steps AND "DI MAIN P02".to_P01_Pallet.ReadyToGo AND "DI MAIN P01".to_P02_Pallet.Request;

       

    1: //V90_A/V90_B MovAbso towards start position, V23Y6/V23Y7 suction valve WP, V28Y12/V28Y34 drive cylinder WP

        IF #SSM.S.stepfc THEN

            "DI MAIN P01".MoDA.RunTimeCntr_seq1 := 0;

            #Ref_StartPos.X := "DI OUT P02".M32_Pallet_Data.Pallet_Ref_Pos_X;

            #Ref_StartPos.Y := "DI OUT P02".M32_Pallet_Data.Pallet_Ref_Pos_Y;

            IF "DI OUT P02".M32_Pallet_Data.Workpiece_2.NumOfWorkPieces = 0 THEN

                #Done := TRUE;

                RETURN;

            END_IF;

            #MaxParts := "DI OUT P02".M32_Pallet_Data.WorkPiece_1.NumOfWorkPieces + "DI OUT P02".M32_Pallet_Data.Workpiece_2.NumOfWorkPieces;

            "HMI KEY".Message.Index_Position := "HMI KEY".Message.Index_Position + 1;

            #ExecuteCoodinate(INDEX_POS := "HMI KEY".Message.Index_Position,

                              REF_POS := #Ref_StartPos,

                              PLACES_ON_X := "DI OUT P02".M32_Pallet_Data.Workpiece_2.PalletPlaceOn_X,

                              PLACES_ON_Y := "DI OUT P02".M32_Pallet_Data.Workpiece_2.PalletPlaceOn_Y,

                              GAP_FACTOR_X := "DI OUT P02".M32_Pallet_Data.Workpiece_2.Gap_X,

                              GAP_FACTOR_Y := "DI OUT P02".M32_Pallet_Data.Workpiece_2.Gap_Y,

                              TARGET_POS := #TrgtPos);

            "DI OUT P01".S210_Z.DRV.Support.SetVelo := "DI OUT P02".M32_Pallet_Data.Workpiece_2.RapidVelo_Z;

            "DI OUT P01".S210_Z.DRV.MC_MoveAbsolute.Position := 200.0; // mc090523

            "DI OUT P01".V90_A.DRV.Support.SetVelo := "HMI KEY".SetPointComp_A[0].RapidVelo;

            "DI OUT P01".V90_A.DRV.MC_MoveAbsolute.Position := "HMI KEY".SetPointComp_A[0].Position;

            "DI OUT P01".V90_B.DRV.Support.SetVelo := "HMI KEY".SetPointComp_B[0].RapidVelo;

            "DI OUT P01".V90_B.DRV.MC_MoveAbsolute.Position := "HMI KEY".SetPointComp_B[0].Position;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := FALSE;

        ELSE

            #tmp_V90_A_inpos := "DI OUT P01".V90_A.DRV.Support.InPos AND NOT #SSM.S.steplo;

            #tmp_V90_B_inpos := "DI OUT P01".V90_B.DRV.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".V23Y6.CmdExe_WP := "HMI KEY".P01.V23Y6.F12_Enable_WP AND NOT #tmp_V90_A_inpos AND #SSM.S.stepa;

            "DI OUT P01".V23Y7.CmdExe_WP := "HMI KEY".P01.V23Y7.F12_Enable_WP AND NOT #tmp_V90_B_inpos AND #SSM.S.stepa;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_WP := "HMI KEY".P01.V28Y12.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.MC_MoveAbsolute.Busy AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_WP := "HMI KEY".P01.V28Y34.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.MC_MoveAbsolute.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveAbsolute := "DI OUT P01".V90_A.DRV.Support.Epos_Enabled AND NOT #tmp_V90_A_inpos AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveAbsolute := "DI OUT P01".V90_B.DRV.Support.Epos_Enabled AND NOT #tmp_V90_B_inpos AND #SSM.S.stepa;

            "FC POS REACHED"(START := #SSM.S.steplo OR NOT #SSM.S.stepa,

                             TARGET_POS := #TrgtPos,

                             VELO_X := "DI OUT P02".M32_Pallet_Data.Workpiece_2.RapidVelo_X,

                             VELO_Y := "DI OUT P02".M32_Pallet_Data.Workpiece_2.RapidVelo_Y,

                             ENABLE_X := "DI OUT P01".S120_X.DRV.Support.Epos_Enabled,

                             ENABLE_Y := "DI OUT P01".S120_Y.DRV.Support.Epos_Enabled,

                             WINDOW_RANGE := 0.1,

                             MOV_TO_POS_X => "DI OUT P01".S120_X.DRV.Support.Cmd_MoveAbsolute,

                             MOV_TO_POS_Y => "DI OUT P01".S120_Y.DRV.Support.Cmd_MoveAbsolute,

                             TARGET_REACHED => #SSM.S.c1.start);

            #SSM.S.stepd := #SSM.S.c1.done AND "DI OUT P01".S210_Z.DRV.Support.InPos AND #tmp_V90_A_inpos AND #tmp_V90_B_inpos;

            "DI OUT P01".S210_Z.DRV.Support.Cmd_MoveAbsolute := "DI OUT P01".S210_Z.DRV.Support.Epos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

        END_IF;

       

    2: // S210_Z MovAbso towards WP (downward)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".S210_Z.DRV.Support.SetVelo := "DI OUT P02".M32_Pallet_Data.Workpiece_2.WorkVelo_Z; // mm/s

            "DI OUT P01".S210_Z.DRV.MC_MoveAbsolute.Position := "DI OUT P02".M32_Pallet_Data.Workpiece_2.WorkPos_Z;

        ELSE

            #SSM.S.stepd := "DI OUT P01".S210_Z.DRV.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".S210_Z.DRV.Support.Cmd_MoveAbsolute := "DI OUT P01".S210_Z.DRV.Support.Epos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

        END_IF;

       

    3: // CARTESIAN_3D MoveLinearRelative distance "01_MovLinRela_ab" y(-40.53)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_WP := "DI OUT P01".V28Y34.VLV_OC.CmdExe_WP := FALSE;

            "DI OUT P01".V90_A.DRV.Support.SetVelo := "HMI KEY".SetPointComp_A[0].WorkVelo;

            "DI OUT P01".V90_B.DRV.Support.SetVelo := "HMI KEY".SetPointComp_B[0].WorkVelo * "HMI KEY".SetPointComp_B[0].MixingRatio / "HMI KEY".SetPointComp_A[0].MixingRatio;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data.Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := "DI OUT P02".M32_Pallet_Data.Workpiece_2."01_MovRela_ab".Y;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    4: // CARTESIAN_3D MoveLinearRelative distance "02_MovLinRela_bc" x(236.0)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."02_MovRela_bc".X;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := 0.0;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    5: // CARTESIAN_3D MoveLinearRelative distance "03_MovLinRela_cd" y(118.0)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."03_MovRela_cd".Y;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    6: // CARTESIAN_3D MoveCircularRelative EndPoint "04_MovLinRela_de" y(1.0)CircMode_2, r=50.0, PathChoice=3/acw

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.EndPoint[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.EndPoint[2] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."04_MovRela_de".Y;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.CircMode := "DI OUT P02".M32_Pallet_Data.Workpiece_2."04_MovRela_de".CircMode;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.Radius := "DI OUT P02".M32_Pallet_Data.Workpiece_2."04_MovRela_de".Radius;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.PathChoice := "DI OUT P02".M32_Pallet_Data.Workpiece_2."04_MovRela_de".PathChoice;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveCircularRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    7: // CARTESIAN_3D MoveLinearRelative distance "05_MovLinRela_ef" y(117.0)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."05_MovRela_ef".Y;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    8: // CARTESIAN_3D MoveLinearRelative distance "06_MovLinRela_fg" x(-236.0)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := "DI OUT P02".M32_Pallet_Data.Workpiece_2."06_MovRela_fg".X;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := 0.0;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    9: // CARTESIAN_3D MoveLinearRelative distance "07_MovLinRela_gh" y(-117.0)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."07_MovRela_gh".Y;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    10: // CARTESIAN_3D MoveCircularRelative EndPoint "08_MovCirRela_hi" y(-1.0)CircMode_2, r=50.0 PathChoice=3/acw

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.EndPoint[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.EndPoint[2] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."08_MovRela_hi".Y;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.Radius := "DI OUT P02".M32_Pallet_Data.Workpiece_2."08_MovRela_hi".Radius;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.CircMode := "DI OUT P02".M32_Pallet_Data.Workpiece_2."08_MovRela_hi".CircMode;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveCircularRelative.PathChoice := "DI OUT P02".M32_Pallet_Data.Workpiece_2."08_MovRela_hi".PathChoice;

        ELSE

            #SSM.S.stepd := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveCircularRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepd AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

        END_IF;

       

    11: // CARTESIAN_3D MoveLinearRelative distance "14_MovLinRela_a" y(-70.0)

        IF #SSM.S.stepfc THEN

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Velocity := "DI OUT P02".M32_Pallet_Data. Workpiece_2.Velocity_3D;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[1] := 0.0;

            "DI OUT P01".CARTESIAN_3D.KIN.MC_MoveLinearRelative.Distance[2] := "DI OUT P02".M32_Pallet_Data. Workpiece_2."14_MovRela_a".Y;

        ELSE

            #SSM.S.stepllo := "DI OUT P01".CARTESIAN_3D.KIN.Support.InPos AND NOT #SSM.S.steplo;

            "DI OUT P01".CARTESIAN_3D.KIN.Support.Cmd_MoveLinearRelative := "DI OUT P01".CARTESIAN_3D.KIN.Support.KINpos_Enabled AND NOT #SSM.S.stepllo AND #SSM.S.stepa;

            // (gasketing on)

            "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_A.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND NOT #SSM.S.stepllo AND #SSM.S.stepa;

            "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP := "HMI KEY".P01.V90_B.F12_Enable_WP AND "DI OUT P01".CARTESIAN_3D.KIN.Support.Busy AND NOT #SSM.S.stepllo AND #SSM.S.stepa;

            "DI OUT P01".V23Y4.CmdExe_WP := "HMI KEY".P01.V23Y4.F12_Enable_WP AND "DI OUT P01".V90_A.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V23Y5.CmdExe_WP := "HMI KEY".P01.V23Y5.F12_Enable_WP AND "DI OUT P01".V90_B.DRV.Support.Cmd_MoveJogWP;

            "DI OUT P01".V28Y12.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y12.F11_Enable_HP AND #SSM.S.stepa;

            "DI OUT P01".V28Y34.VLV_OC.CmdExe_HP := "HMI KEY".P01.V28Y34.F11_Enable_HP AND #SSM.S.stepa;

            #SSM.S.stepd := #SSM.S.stepllo AND "DI OUT P01".V90_A.DRV.Support.LampOFF AND "DI OUT P01".V90_B.DRV.Support.LampOFF;

        END_IF;

       

    12: // Query ending sector 1 if necessary

        IF #SSM.S.stepfc THEN

            "DI MAIN P01".M00.ProductCounter.GoodProducts := "DI MAIN P01".M00.ProductCounter.GoodProducts + 1;

        ELSIF "HMI KEY".Message.Index_Position >= #MaxParts THEN

            #Done := TRUE;

        ELSE

            #SSM.S.stepnew := 1;

            #SSM.S.stepd := TRUE;

        END_IF;

END_CASE;