EX009_MotorControl()

/* ############## URUCHOMIENIE MASZYNY STANÓW ############## */
// Initialization State Machine or Stop System
IF(#StartSystem = FALSE AND #tempInitializationStateMachine = FALSE) THEN
    #tempInitializationStateMachine := TRUE;
    #tempStepMemory := #tempStep;
    #tempTriggerMemory := #tempTrigger;
    #tempStepDoneMemory := #tempStepDone;
    #tempStepDone := TRUE;
    #tempTrigger := 0;
    #tempStep := 0;
END_IF;

// Start State Machine
IF(#StartSystem = TRUE AND #tempInitializationStateMachine  = TRUE) THEN
    #tempInitializationStateMachine := FALSE;
    #tempStep := #tempStepMemory;
    #tempTrigger := #tempTriggerMemory;
    #tempStepDone := #tempStepDoneMemory;
END_IF;

/* ############## PRZEŁĄCZANIE STANÓW ############## */
// State 1
IF(#tempStep = "CONST_EX009_STEP_RUN_MOTOR1" AND #tempStepDone = FALSE) THEN
    IF(#Presure = TRUE) THEN
        #tempTrigger := "CONST_EX009_STEP_RUN_MOTOR1";
        #tempStepDone := TRUE;
        #tempStep := "CONST_EX009_STEP_RUN_MOTOR2";
    END_IF;
END_IF;

// State 2
IF(#tempStep = "CONST_EX009_STEP_RUN_MOTOR2" AND #tempStepDone = FALSE) THEN
    IF(#Presure = TRUE) THEN
        #tempTrigger := "CONST_EX009_STEP_RUN_MOTOR2";
        #tempStepDone := TRUE;
        #tempStep := "CONST_EX009_STEP_RUN_MOTOR1";
    END_IF;
END_IF;

// State Stop State Machine
IF(#tempTrigger = 0 AND #tempStepDone = TRUE) THEN
    #ParametersMotor1.RunOnOff := FALSE;
    #ParametersMotor2.RunOnOff := FALSE;
END_IF;

/* ############## WYKONYWANE CZYNNOŚCI W DANYM KROKU ############## */
// State 1
IF(#tempStep = "CONST_EX009_STEP_RUN_MOTOR1" AND #tempStepDone = TRUE) THEN
    #ParametersMotor1.RunOnOff := TRUE;
    IF(#Presure = FALSE) THEN
        #ParametersMotor1.RunOnOff := FALSE;
        #tempStepDone := FALSE;
    END_IF;
END_IF;

// State 2
IF(#tempStep = "CONST_EX009_STEP_RUN_MOTOR2" AND #tempStepDone = TRUE) THEN
    #ParametersMotor2.RunOnOff := TRUE;
    IF(#Presure = FALSE) THEN
        #ParametersMotor2.RunOnOff := FALSE;
        #tempStepDone := FALSE;
    END_IF;
END_IF;