https://pastein.ru/t/AbB
Загрузка данных
METHOD CyclicCall
VAR
i : INT;
a : INT;
a2 : INT;
podAtPos0 : INT;
bestIdx : INT;
bestTime : DT;
allEvacuated : BOOL;
sourcePos : INT;
route : E_RouteType;
curStep : INT;
expectedVat : INT;
targetVat : INT;
firstVat : INT;
GetTargetVatForPodveska : INT;
IsPodveskaReadyToUnload : BOOL;
CanLoadTargetVat : BOOL;
prio : INT;
highestPrio : INT;
candidateLocal : INT;
aoJobSourceLocal : INT;
aoJobDestLocal : INT;
savedBusy : ARRAY[1..17] OF DT;
savedStart : ARRAY[1..17] OF DT;
evacuateCandidate : BOOL;
evacuateLeader : BOOL;
BEGIN
// ============================================================================
// БЛОК 1: СИНХРОНИЗАЦИЯ С ФИЗИЧЕСКИМ СОСТОЯНИЕМ ЛИНИИ (АЛГОРИТМ Б)
// ============================================================================
FOR i := 1 TO 17 DO
IF GVL.vanBusy[i] THEN
GVL.planVatBusyUntil[i] := MAX(GVL.vanEndTime[i], GVL.sysTime);
ELSE
GVL.planVatBusyUntil[i] := GVL.sysTime;
END_IF;
END_FOR;
// ============================================================
// Однократная инициализация (firstScan – VAR_STAT в FB)
// ============================================================
IF gvl.firstScan THEN
FOR i := 1 TO 17 DO
GVL.planVatFreeTime[i] := GVL.sysTime;
GVL.planVatBusyUntil[i] := GVL.sysTime;
GVL.planVatStartTime[i] := GVL.sysTime;
END_FOR;
GVL.loadPosBusy := FALSE;
FOR a := 1 TO 4 DO
IF GVL.podveskas[a].currentPos = 0 THEN
GVL.loadPosBusy := TRUE;
EXIT;
END_IF
END_FOR
FOR a := 1 TO 4 DO
IF (GVL.podveskas[a].currentPos >= 101 AND GVL.podveskas[a].currentPos <= 103) THEN
GVL.podveskas[a].bufferEntryTime := GVL.sysTime;
END_IF
END_FOR
RebuildBufferAndLoadStatus();
GVL.aoJobSource := -1;
GVL.aoJobDest := -1;
gvl.firstScan := FALSE;
END_IF
// ============================================================
// Обработка кнопки Reset
// ============================================================
IF GVL.Reset THEN
GVL.Reset := FALSE;
GVL.resetActive := TRUE;
FOR a := 1 TO 4 DO
IF GVL.podveskas[a].currentStep >= 0 THEN
GVL.podveskas[a].currentStep := -1;
GVL.podveskas[a].xLoaded := FALSE;
GVL.podveskas[a].xUnloaded := FALSE;
END_IF
END_FOR
RebuildBufferAndLoadStatus();
END_IF
IF GVL.resetActive THEN
allEvacuated := TRUE;
FOR a := 1 TO 4 DO
IF NOT ((GVL.podveskas[a].currentPos = 0) OR
(GVL.podveskas[a].currentPos >= 101 AND GVL.podveskas[a].currentPos <= 103)) THEN
allEvacuated := FALSE;
EXIT;
END_IF
END_FOR
IF allEvacuated THEN
GVL.resetActive := FALSE;
END_IF
END_IF
// ============================================================
// Основной блок – только когда автооператор свободен
// ============================================================
IF NOT GVL.aoBusy THEN
RebuildBufferAndLoadStatus();
GVL.aoJobSource := -1;
GVL.aoJobDest := -1;
GVL.candidate := 0;
// ============================================================================
// БЛОК 2: КАСКАДНОЕ НАКОПЛЕНИЕ ПРОГНОЗОВ АКТИВНЫХ ПОДВЕСОК
// ============================================================================
FOR a := 1 TO 4 DO
IF GVL.podveskas[a].currentStep >= 0 THEN
EvaluatePodveska(podveska := GVL.podveskas[a]);
FOR i := 1 TO 17 DO
GVL.planVatBusyUntil[i] := MAX(GVL.planVatBusyUntil[i], GVL.podveskas[a].simBusyUntil[i]);
GVL.planVatStartTime[i] := MAX(GVL.planVatStartTime[i], GVL.podveskas[a].simStartTime[i]);
END_FOR;
END_IF;
END_FOR;
// ---------- Обработка кнопок "Загружена" / "Разгружена" ----------
IF NOT GVL.resetActive THEN
podAtPos0 := 0;
FOR a := 1 TO 4 DO
IF GVL.podveskas[a].currentPos = 0 THEN
podAtPos0 := a;
EXIT;
END_IF
END_FOR
IF podAtPos0 > 0 THEN
// ----- На позиции 0 уже стоит подвеска -----
IF GVL.PodLoaded AND (GVL.podveskas[podAtPos0].currentStep = -1) THEN
IF (Control_HMI.processType = E_RouteType.eTin) OR
(Control_HMI.processType = E_RouteType.eSilver) THEN
GVL.podveskas[podAtPos0].processType := Control_HMI.processType;
GVL.podveskas[podAtPos0].xLoaded := TRUE;
GVL.podveskas[podAtPos0].xUnloaded := FALSE;
GVL.podveskas[podAtPos0].currentStep := 0;
GVL.PodLoaded := FALSE;
GVL.BtnLoaded_Sn_push := FALSE;
GVL.BtnLoaded_Ag_push := FALSE;
// Очищаем старые планы перед новой симуляцией
FOR i := 1 TO 17 DO
GVL.podveskas[podAtPos0].simStartTime[i] := DT#1970-01-01-00:00:00;
GVL.podveskas[podAtPos0].simBusyUntil[i] := DT#1970-01-01-00:00:00;
END_FOR;
// Планы будут рассчитаны в основном цикле выбора победителя
ELSE
GVL.PodLoaded := FALSE;
END_IF
END_IF
// *** ИЗМЕНЁННАЯ ОБРАБОТКА КНОПКИ "РАЗГРУЖЕНО" ***
IF GVL.PodUnLoaded AND (GVL.podveskas[podAtPos0].currentStep = -1) THEN
GVL.podveskas[podAtPos0].xUnloaded := TRUE;
GVL.podveskas[podAtPos0].xLoaded := FALSE;
GVL.PodUnLoaded := FALSE;
GVL.BtnUnLoaded_push := FALSE;
IF (Main.bufferHolds[1] <> 0) AND (Main.bufferHolds[2] <> 0) AND (Main.bufferHolds[3] <> 0) THEN
IF NOT GVL.vanBusy[1] THEN
GVL.aoJobSource := 0;
GVL.aoJobDest := 1;
GVL.candidate := podAtPos0;
GVL.aoBusy := TRUE;
gvl.AutoLoadFromBuffer := TRUE;
RETURN;
END_IF
END_IF
END_IF
ELSE
// ----- Позиция 0 свободна -----
// *** АВТОМАТИЧЕСКИЙ ВЫЗОВ ПОДВЕСКИ ИЗ БУФЕРА ПОСЛЕ ЭКСТРЕННОЙ РАЗГРУЗКИ ***
IF gvl.AutoLoadFromBuffer THEN
bestIdx := 0;
bestTime := DT#2100-01-01-00:00:00;
FOR a := 1 TO 4 DO
IF (GVL.podveskas[a].currentStep = -1) AND
(GVL.podveskas[a].currentPos >= 101 AND GVL.podveskas[a].currentPos <= 103) THEN
IF (GVL.podveskas[a].bufferEntryTime < bestTime) THEN
bestTime := GVL.podveskas[a].bufferEntryTime;
bestIdx := a;
END_IF
END_IF
END_FOR
IF bestIdx > 0 THEN
GVL.aoJobSource := GVL.podveskas[bestIdx].currentPos;
GVL.aoJobDest := 0;
GVL.candidate := bestIdx;
gvl.AutoLoadFromBuffer := FALSE;
GVL.podveskas[bestIdx].xLoaded := FALSE;
GVL.podveskas[bestIdx].xUnloaded := FALSE;
GVL.aoBusy := TRUE;
RETURN;
ELSE
gvl.AutoLoadFromBuffer := FALSE;
END_IF
END_IF
IF GVL.PodLoaded THEN
bestIdx := 0;
bestTime := DT#2100-01-01-00:00:00;
FOR a := 1 TO 4 DO
IF (GVL.podveskas[a].currentStep = -1) AND
(GVL.podveskas[a].currentPos >= 101 AND GVL.podveskas[a].currentPos <= 103) AND
(NOT GVL.podveskas[a].xUnloaded) THEN
IF (GVL.podveskas[a].bufferEntryTime < bestTime) THEN
bestTime := GVL.podveskas[a].bufferEntryTime;
bestIdx := a;
END_IF
END_IF
END_FOR
IF bestIdx = 0 THEN
FOR a := 1 TO 4 DO
IF (GVL.podveskas[a].currentStep = -1) AND
(GVL.podveskas[a].currentPos >= 101 AND GVL.podveskas[a].currentPos <= 103) THEN
IF (GVL.podveskas[a].bufferEntryTime < bestTime) THEN
bestTime := GVL.podveskas[a].bufferEntryTime;
bestIdx := a;
END_IF
END_IF
END_FOR
END_IF
IF bestIdx > 0 THEN
GVL.aoJobSource := GVL.podveskas[bestIdx].currentPos;
GVL.aoJobDest := 0;
GVL.candidate := bestIdx;
GVL.PodLoaded := FALSE;
GVL.BtnLoaded_Sn_push := FALSE;
GVL.BtnLoaded_Ag_push := FALSE;
GVL.podveskas[bestIdx].xLoaded := FALSE;
GVL.podveskas[bestIdx].xUnloaded := FALSE;
GVL.aoBusy := TRUE;
RETURN;
ELSE
GVL.PodLoaded := FALSE;
GVL.BtnLoaded_Sn_push := FALSE;
GVL.BtnLoaded_Ag_push := FALSE;
END_IF
END_IF
END_IF
END_IF
// ---------- Основной цикл выбора победителя ----------
highestPrio := -201;
candidateLocal := 0;
aoJobSourceLocal := -1;
aoJobDestLocal := -1;
evacuateLeader := FALSE;
FOR a := 1 TO 4 DO
evacuateCandidate := FALSE;
sourcePos := GVL.podveskas[a].currentPos;
route := GVL.podveskas[a].processType;
curStep := GVL.podveskas[a].currentStep;
expectedVat := GetVatFromRecipe(route, curStep);
GetTargetVatForPodveska := 0;
IF curStep >= 0 AND curStep <= 13 THEN
CASE route OF
E_RouteType.eTin:
GetTargetVatForPodveska := TargetVars.recipeTin[curStep + 1].vatNo;
E_RouteType.eSilver:
GetTargetVatForPodveska := TargetVars.recipeSilver[curStep + 1].vatNo;
END_CASE
END_IF
targetVat := GetTargetVatForPodveska;
// ---------- Логика для завершённых подвесок ----------
IF curStep < 0 THEN
IF sourcePos = 0 THEN
IF GVL.podveskas[a].xUnloaded THEN
IF Main.bufferHolds[1] = 0 THEN
targetVat := 101;
IsPodveskaReadyToUnload := TRUE;
ELSIF Main.bufferHolds[2] = 0 THEN
targetVat := 102;
IsPodveskaReadyToUnload := TRUE;
ELSIF Main.bufferHolds[3] = 0 THEN
targetVat := 103;
IsPodveskaReadyToUnload := TRUE;
ELSE
IF NOT GVL.vanBusy[1] THEN
bestIdx := 0;
bestTime := DT#2100-01-01-00:00:00;
FOR a2 := 1 TO 4 DO
IF (GVL.podveskas[a2].currentStep = -1) AND
(GVL.podveskas[a2].currentPos >= 101 AND GVL.podveskas[a2].currentPos <= 103) THEN
IF (GVL.podveskas[a2].bufferEntryTime < bestTime) THEN
bestTime := GVL.podveskas[a2].bufferEntryTime;
bestIdx := a2;
END_IF
END_IF
END_FOR
IF bestIdx > 0 THEN
candidateLocal := bestIdx;
aoJobSourceLocal := GVL.podveskas[bestIdx].currentPos;
aoJobDestLocal := 1;
evacuateLeader := FALSE;
EXIT;
END_IF
END_IF
IsPodveskaReadyToUnload := FALSE;
END_IF
ELSE
IsPodveskaReadyToUnload := FALSE;
CONTINUE;
END_IF
ELSIF sourcePos >= 101 AND sourcePos <= 103 THEN
CONTINUE;
ELSIF sourcePos >= 1 AND sourcePos <= 17 THEN
IsPodveskaReadyToUnload := TRUE;
IF Main.bufferHolds[1] = 0 THEN
targetVat := 101;
ELSIF Main.bufferHolds[2] = 0 THEN
targetVat := 102;
ELSIF Main.bufferHolds[3] = 0 THEN
targetVat := 103;
ELSIF NOT GVL.loadPosBusy THEN
targetVat := 0;
ELSE
targetVat := -1;
END_IF
ELSE
CONTINUE;
END_IF
ELSE
IsPodveskaReadyToUnload := FALSE;
IF sourcePos = 0 OR (sourcePos >= 101 AND sourcePos <= 103) THEN
IsPodveskaReadyToUnload := TRUE;
END_IF
IF sourcePos >= 1 AND sourcePos <= 17 THEN
IF sourcePos <> expectedVat THEN
IsPodveskaReadyToUnload := FALSE;
END_IF
IF GVL.vanEndTime[sourcePos] < GVL.sysTime THEN
IsPodveskaReadyToUnload := TRUE;
END_IF
IF (sourcePos = 4 OR sourcePos = 8 OR sourcePos = 13 OR sourcePos = 16) AND GVL.vanBusy[sourcePos - 1] THEN
IsPodveskaReadyToUnload := FALSE;
END_IF
END_IF
END_IF
IF IsPodveskaReadyToUnload THEN
IF targetVat < 0 THEN
CanLoadTargetVat := FALSE;
ELSIF targetVat = 0 THEN
CanLoadTargetVat := (NOT GVL.loadPosBusy);
ELSIF targetVat >= 1 AND targetVat <= 17 THEN
CanLoadTargetVat := NOT GVL.vanBusy[targetVat];
ELSIF targetVat >= 101 AND targetVat <= 103 THEN
CanLoadTargetVat := (Main.bufferHolds[targetVat - 100] = 0);
ELSE
CanLoadTargetVat := FALSE;
END_IF
IF (sourcePos >= 1 AND sourcePos <= 17) AND (curStep >= 0) AND (targetVat = 0) AND (NOT CanLoadTargetVat) THEN
IF Main.bufferHolds[1] = 0 THEN
targetVat := 101;
CanLoadTargetVat := TRUE;
evacuateCandidate := TRUE;
ELSIF Main.bufferHolds[2] = 0 THEN
targetVat := 102;
CanLoadTargetVat := TRUE;
evacuateCandidate := TRUE;
ELSIF Main.bufferHolds[3] = 0 THEN
targetVat := 103;
CanLoadTargetVat := TRUE;
evacuateCandidate := TRUE;
END_IF
END_IF
IF (sourcePos = 0) AND (curStep >= 0) AND (NOT CanLoadTargetVat) THEN
IF Main.bufferHolds[1] = 0 THEN
targetVat := 101;
CanLoadTargetVat := TRUE;
ELSIF Main.bufferHolds[2] = 0 THEN
targetVat := 102;
CanLoadTargetVat := TRUE;
ELSIF Main.bufferHolds[3] = 0 THEN
targetVat := 103;
CanLoadTargetVat := TRUE;
ELSE
CanLoadTargetVat := FALSE;
END_IF
END_IF
IF CanLoadTargetVat THEN
FOR i := 1 TO 17 DO
savedBusy[i] := GVL.planVatBusyUntil[i];
savedStart[i] := GVL.planVatStartTime[i];
END_FOR;
FOR i := 1 TO 17 DO
GVL.planVatBusyUntil[i] := MAX(GVL.planVatBusyUntil[i], GVL.podveskas[a].simBusyUntil[i]);
GVL.planVatStartTime[i] := MAX(GVL.planVatStartTime[i], GVL.podveskas[a].simStartTime[i]);
END_FOR;
prio := 0;
IF (route = E_RouteType.eTin AND curStep = 8 AND sourcePos = 10) OR
(route = E_RouteType.eSilver AND curStep = 8 AND sourcePos = 6) THEN
prio := prio + 1000;
END_IF
IF sourcePos >= 1 AND sourcePos <= 17 AND curStep > 0 THEN
prio := prio + ULINT_TO_INT(TIME_TO_ULINT(GVL.sysTime - GVL.vanEndTime[sourcePos]) / 1000);
END_IF
IF (route = E_RouteType.eTin AND targetVat = 11) OR
(route = E_RouteType.eSilver AND targetVat = 5) THEN
prio := prio + 500;
END_IF
IF ((sourcePos = 0) OR (sourcePos >= 101 AND sourcePos <= 103)) AND (curStep >= 0) THEN
prio := prio + 700;
END_IF
IF sourcePos >= 101 AND sourcePos <= 103 THEN
prio := prio - 200;
prio := prio + ULINT_TO_INT(TIME_TO_ULINT(GVL.sysTime - GVL.podveskas[a].bufferEntryTime) / 1000);
END_IF
IF (sourcePos = 3 OR sourcePos = 7 OR sourcePos = 12 OR sourcePos = 15) THEN
IF GVL.vanBusy[sourcePos + 1] THEN
prio := prio + 600;
END_IF
END_IF
IF (curStep < 0) AND (sourcePos = 0) THEN
prio := prio + 2600;
END_IF
IF (curStep < 0) AND (sourcePos >= 1 AND sourcePos <= 17) THEN
prio := prio + 2500;
END_IF
IF GVL.resetActive AND (curStep < 0) AND (sourcePos >= 1 AND sourcePos <= 17) THEN
prio := prio + 3000;
END_IF
gvl.testPrio[a] := prio;
IF prio > highestPrio THEN
highestPrio := prio;
candidateLocal := a;
aoJobSourceLocal := sourcePos;
aoJobDestLocal := targetVat;
evacuateLeader := evacuateCandidate;
END_IF;
FOR i := 1 TO 17 DO
GVL.planVatBusyUntil[i] := savedBusy[i];
GVL.planVatStartTime[i] := savedStart[i];
END_FOR;
END_IF
END_IF
END_FOR
// ----------------------------------------------------------
// Запуск движения для выбранного кандидата
// ----------------------------------------------------------
IF candidateLocal > 0 THEN
GVL.candidate := candidateLocal;
GVL.aoJobSource := aoJobSourceLocal;
GVL.aoJobDest := aoJobDestLocal;
IF evacuateLeader THEN
GVL.podveskas[GVL.candidate].currentStep := -1;
GVL.podveskas[GVL.candidate].xLoaded := FALSE;
END_IF;
FOR i := 1 TO 17 DO
GVL.planVatBusyUntil[i] := MAX(GVL.planVatBusyUntil[i], GVL.podveskas[GVL.candidate].simBusyUntil[i]);
GVL.planVatStartTime[i] := MAX(GVL.planVatStartTime[i], GVL.podveskas[GVL.candidate].simStartTime[i]);
END_FOR;
GVL.aoBusy := TRUE;
END_IF;
END_IF; // конец IF NOT GVL.aoBusy
END_METHOD