Files

178 lines
14 KiB
Plaintext

FUNCTION_BLOCK "MPS2_OmniFahren"
{ S7_Optimized_Access := 'FALSE' }
// Mechanische AWL->SCL-Konvertierung (awl2scl.py). Kontrollfluss per GOTO,
// wo im Original mit Sprungmarken gearbeitet wurde. Vor Uebernahme in TIA
// Portal pruefen/kompilieren (siehe SCL-Export/README.md).
VAR_OUTPUT
PF0054 : Word; // war "PF0054"
PF3420 : Word; // war "PF3420"
END_VAR
VAR_IN_OUT
BG3414 : Word; // war "BG3414"
BG3421 : Word; // war "BG3421"
BG3422 : Word; // war "BG3422"
BG3423 : Word; // war "BG3423"
BG3425 : Word; // war "BG3425"
BG3431 : Word; // war "BG3431"
BG3435 : Word; // war "BG3435"
BG3440 : Word; // war "BG3440"
BG3441 : Word; // war "BG3441"
BG3443 : Word; // war "BG3443"
BG3444 : Word; // war "BG3444"
BG3445 : Word; // war "BG3445"
DAMR_Bereich : Word; // war "DAMR_Bereich"
DArbeitspl_tze_Antriebe : Word; // war "DArbeitsplätze_Antriebe"
DArbeitspl_tze_Sensoren : Word; // war "DArbeitsplätze_Sensoren"
DArbeitspl_tze_Zylinder : Word; // war "DArbeitsplätze_Zylinder"
DPS5_OmniFahren : Word; // war "DPS5_OmniFahren"
MA0101 : Bool; // war "MA0101"
MA0102 : Bool; // war "MA0102"
MA0103 : Bool; // war "MA0103"
MA0104 : Bool; // war "MA0104"
MA0105 : Bool; // war "MA0105"
MA0112 : Bool; // war "MA0112"
MB3421 : Byte; // war "MB3421"
MB3422 : Byte; // war "MB3422"
MB3423 : Byte; // war "MB3423"
MB3425 : Byte; // war "MB3425"
MB3431 : Byte; // war "MB3431"
MB3435 : Byte; // war "MB3435"
MB3441 : Byte; // war "MB3441"
MB3443 : Byte; // war "MB3443"
END_VAR
VAR
Schleuse_vor_Einfahrt { S7_SetPoint := 'False'} : "MHMOmniSchleuse";
Weiche_Einfahrt { S7_SetPoint := 'False'} : "MHMOmniWeiche";
Schleuse_Vorstau { S7_SetPoint := 'False'} : "MHMOmniSchleuse";
Sks_Arbeitsplatz { S7_SetPoint := 'False'} : "MHM_Arbeitsplatz";
Schleuse_Platz_1 { S7_SetPoint := 'False'} : "MHMOmniSchleuse";
Schleuse_Platz_2 { S7_SetPoint := 'False'} : "MHMOmniSchleuse";
Schleuse_Platz_3 { S7_SetPoint := 'False'} : "MHMOmniSchleuse";
Schleuse_Ausfahrt : "MHMOmniSchleuse";
Schleuse_vor_Ausfahrt { S7_SetPoint := 'False'} : "MHMOmniSchleuse";
Prio_Ausfahrt { S7_SetPoint := 'False'} : "MAusfahrPrio_ABP";
Vorfahrt_Ausfahrweiche : Struct
"Weiche_von_Haupt-Sep_belegt" : Bool;
"Weiche_von_Ausfahr-Sep_belegt" : Bool;
Haupstrecke_gefahren : Int;
AMR_gefahren : Int;
END_STRUCT;
END_VAR
VAR_TEMP
ErrQuit : Bool;
ErrAnz : Bool;
Stau_raus : Bool;
Start_ok : Bool;
B_aktiv : Bool;
B_AusSchleuse : Bool;
Antrieb_aktiv : Bool;
Antrieb_start : Bool;
Antrieb_stop : Bool;
Fahren_Ok : Bool;
END_VAR
BEGIN
REGION Systemzeug
#Schleuse_vor_Einfahrt.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Weiche_Einfahrt.Dyn.Status.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Sks_Arbeitsplatz.Dyn.Sk_zum_Beladeplatz.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_Vorstau.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_Platz_1.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_Platz_2.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_Platz_3.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Sks_Arbeitsplatz.Dyn.Sk_aus_Beladeplatz.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_Ausfahrt.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_vor_Ausfahrt.Dyn.Sk.Auto_akt := #DAMR_Bereich.A01_UH06.AnlageEin;
#Schleuse_vor_Einfahrt.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Weiche_Einfahrt.Dyn.Status.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Sks_Arbeitsplatz.Dyn.Sk_zum_Beladeplatz.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Schleuse_Vorstau.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Schleuse_Platz_1.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Schleuse_Platz_2.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Schleuse_Platz_3.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Sks_Arbeitsplatz.Dyn.Sk_aus_Beladeplatz.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Schleuse_Ausfahrt.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
#Schleuse_vor_Ausfahrt.Dyn.Sk.Bereich_ok := NOT (#DAMR_Bereich.A01_UH06.BereichErr);
END_REGION
REGION Störungen quittieren
#ErrQuit := #DAMR_Bereich.A01_UZ0602.StOk_aktiv;
IF #DAMR_Bereich.A01_UZ0602.StOk_aktiv THEN
#DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.A_start := TRUE;
#DArbeitspl_tze_Antriebe."MA _Nachstau1_MPS2".Stat.A_start := TRUE;
#DArbeitspl_tze_Antriebe."MA _Nachstau2_MPS2".Stat.A_start := TRUE;
#DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.A_start := TRUE;
#DArbeitspl_tze_Antriebe.MA0105.Stat.A_start := TRUE;
#DArbeitspl_tze_Antriebe.MA0112.Stat.A_start := TRUE;
END_IF;
END_REGION
REGION Schleuse vor Einfahrt
#Schleuse_vor_Einfahrt(Schleusen_Nr := 3421, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3414, B_InSchleuse := #BG3421, B_AusSchleuse := , B_Stau_raus := , Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0105, Antrieb_plus_aktiv := 1, Schleuse_geöffnet := #MB3421, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Vor_Einfahrt_MPS2.Stat.Ast, Error := %DB608.DBW310, Antrieb_Schleuse_vor := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_vor, Antrieb_Schleuse_start := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_start, Antrieb_Schleuse_stop := #DArbeitspl_tze_Antriebe.MA0105.Stat.Stop_vor, Antrieb_Schleuse_PS := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_PS, hStOk := #ErrAnz); // Über Weiche_Einfahrt | Über Weiche_Einfahrt | Über Weiche_Einfahrt
END_REGION
REGION Weiche Einfahrt
#Weiche_Einfahrt(Weichen_Nr := 3422, ErrQuit := #ErrQuit, Fahren_Ok := 1, B_Ziel_gerade := #DArbeitspl_tze_Sensoren.Stau_nach_Einfahrt_MPS2.Stat.B_Akt, B_Ziel_abzweig := #DArbeitspl_tze_Sensoren.Stau_Einfahrt_MPS2.Stat.B_Akt, Antrieb_Weiche_aktiv := #MA0105, Antrieb_Gerade_aktiv := #MA0105, Antrieb_Abzweig_aktiv := #MA0101, Weiche_ist_AST := #MB3422, Y_Weiche_abzweig := #DArbeitspl_tze_Zylinder.Weiche_Einfahrt_MPS2.Stat.Ast, Error := %DB608.DBW312, Antrieb_Weiche_vor := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_vor, Antrieb_Weiche_stop := #DArbeitspl_tze_Antriebe.MA0105.Stat.Stop_vor, Antrieb_Weiche_gerade_vor := , Antrieb_Weiche_gerade_stop := , Antrieb_Weiche_abzweig_vor := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.A_vor, Antrieb_Weiche_abzweig_stop := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.Stop_vor, hStOk := #ErrAnz); // s.o. | s.o.
END_REGION
REGION Schrittketten Arbeitsplätze ver-/entsorgen
#Sks_Arbeitsplatz(Arbeitsplatz_Nr := 16#B200, ErrQuit := #ErrQuit, B_In_Schleuse_Vorstau := #BG3423, B_an_Platz_1 := #BG3425, B_an_Platz_2 := #BG3431, B_an_Platz_3 := #BG3435, B_Nachstau_Einfahrt := #DArbeitspl_tze_Sensoren.Stau_Ausfahrt_MPS2.Stat.B_Akt, B_Nachstau_Ausfahrt := #BG3441, Y_Vorstau := #MB3423, Y_Platz_1 := #MB3425, Y_Platz_2 := #MB3431, Y_Platz_3 := #MB3435, Antrieb_Vorstau_aktiv := #MA0101, Antrieb_Nachstau_1_aktiv := #MA0102, Antrieb_Nachstau_2_aktiv := #MA0103, Antrieb_Nachstau_3_aktiv := #MA0104, Y_Weiche_zu_Platz_1 := #DArbeitspl_tze_Zylinder.Weiche_zu_Platz1_MPS2.Stat.Ast, Y_Weiche_zu_Platz_2 := #DArbeitspl_tze_Zylinder.Weiche_zu_Platz2_MPS2.Stat.Ast, Y_Weiche_von_Platz_1 := #DArbeitspl_tze_Zylinder.Weiche_von_Platz1_MPS2.Stat.Ast, Y_Weiche_von_Platz_2 := #DArbeitspl_tze_Zylinder.Weiche_von_Platz2_MPS2.Stat.Ast, Antrieb_Nachstau_1_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau1_MPS2".Stat.A_vor, Antrieb_Nachstau_2_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau2_MPS2".Stat.A_vor, Trolley_hat_ABS_erreicht := #Schleuse_Vorstau.B_AusSchleuse, Reset_Vorstau_Schleuse := #Schleuse_Vorstau.Dyn.Sk.Reset, Reset_Platz_1_Stopper := #Schleuse_Platz_1.Dyn.Sk.Reset, Reset_Platz_2_Stopper := #Schleuse_Platz_2.Dyn.Sk.Reset, Reset_Platz_3_Stopper := #Schleuse_Platz_3.Dyn.Sk.Reset, Error := %DB608.DBW112, Antrieb_Vorstau_vor := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.A_vor, Antrieb_Nachstau_3_vor := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.A_vor, hStOk := #ErrAnz); // XY00: X=A(PS), X=B(MPS), Y= Nummer des Platzes
#PF0054 := #DAMR_Bereich.A01_UH06.AnlageEin AND #Sks_Arbeitsplatz.Dyn.Status.Arbeitsplatz_aktiviert;
#PF3420 := #Sks_Arbeitsplatz.Dyn.SS.Externe_Anzeige;
END_REGION
REGION Schleuse Vorstau
#Schleuse_Vorstau(Schleusen_Nr := 3423, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3422, B_InSchleuse := #BG3423, Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0101, Antrieb_plus_aktiv := 1, Schleuse_geöffnet := #MB3423, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Vorstau_MPS2.Stat.Ast, Error := %DB608.DBW314, Antrieb_Schleuse_vor := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.A_vor, Antrieb_Schleuse_start := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.A_start, Antrieb_Schleuse_stop := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.Stop_vor, Antrieb_Schleuse_PS := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS2".Stat.A_PS, hStOk := #ErrAnz);
END_REGION
REGION Schleuse Platz 1
#Schleuse_Platz_1(Schleusen_Nr := 3425, ErrQuit := #ErrQuit, B_InSchleuse := #BG3425, Start_Ok := 1, Antrieb_Schleuse_aktiv := 1, Antrieb_plus_aktiv := #MA0102, Schleuse_geöffnet := #MB3425, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Platz1_MPS2.Stat.Ast, Error := %DB608.DBW316, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau1_MPS2".Stat.A_vor, hStOk := #ErrAnz);
IF #Schleuse_Platz_1.Dyn.Status.Trolley_draussen THEN #Sks_Arbeitsplatz.Dyn.Platz_1.Trolley_hat_Arbeitsplatz_verlassen := TRUE; END_IF;
IF #Schleuse_Platz_1.Dyn.Status.Trolley_draussen THEN #Sks_Arbeitsplatz.Dyn.Platz_1.TrolleyID_ausgefahren := #Schleuse_Platz_1.Dyn.TrolleyID_ausgefahren; END_IF;
END_REGION
REGION Schleuse Platz 2
#Schleuse_Platz_2(Schleusen_Nr := 3431, ErrQuit := #ErrQuit, B_InSchleuse := #BG3431, Start_Ok := 1, Antrieb_Schleuse_aktiv := 1, Antrieb_plus_aktiv := #MA0103, Schleuse_geöffnet := #MB3431, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Platz2_MPS2.Stat.Ast, Error := %DB608.DBW318, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau2_MPS2".Stat.A_vor, hStOk := #ErrAnz);
IF #Schleuse_Platz_2.Dyn.Status.Trolley_draussen THEN #Sks_Arbeitsplatz.Dyn.Platz_2.Trolley_hat_Arbeitsplatz_verlassen := TRUE; END_IF;
IF #Schleuse_Platz_2.Dyn.Status.Trolley_draussen THEN #Sks_Arbeitsplatz.Dyn.Platz_2.TrolleyID_ausgefahren := #Schleuse_Platz_2.Dyn.TrolleyID_ausgefahren; END_IF;
END_REGION
REGION Schleuse Platz 3
#Schleuse_Platz_3(Schleusen_Nr := 3435, ErrQuit := #ErrQuit, B_InSchleuse := #BG3435, Start_Ok := 1, Antrieb_Schleuse_aktiv := 1, Antrieb_plus_aktiv := #MA0104, Schleuse_geöffnet := #MB3435, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Platz3_MPS2.Stat.Ast, Error := %DB608.DBW320, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.A_vor, hStOk := #ErrAnz);
IF #Schleuse_Platz_3.Dyn.Status.Trolley_draussen THEN #Sks_Arbeitsplatz.Dyn.Platz_3.Trolley_hat_Arbeitsplatz_verlassen := TRUE; END_IF;
IF #Schleuse_Platz_3.Dyn.Status.Trolley_draussen THEN #Sks_Arbeitsplatz.Dyn.Platz_3.TrolleyID_ausgefahren := #Schleuse_Platz_3.Dyn.TrolleyID_ausgefahren; END_IF;
END_REGION
REGION Schleuse Ausfahrt
#Schleuse_Ausfahrt(Schleusen_Nr := 3441, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3440, B_InSchleuse := #BG3441, B_AusSchleuse := #BG3444, B_Stau_raus := #DArbeitspl_tze_Sensoren.Stau_nach_Ausfahrt_MPS2.Stat.B_Akt, Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0104, Antrieb_plus_aktiv := #MA0112, Schleuse_geöffnet := #MB3441, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Ausfahrt_MPS2.Stat.Ast, Error := %DB608.DBW322, Antrieb_Schleuse_vor := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.A_vor, Antrieb_Schleuse_start := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.A_start, Antrieb_Schleuse_stop := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.Stop_vor, Antrieb_Schleuse_PS := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS2".Stat.A_PS, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe.MA0112.Stat.A_vor, Antrieb_plus_start := #DArbeitspl_tze_Antriebe.MA0112.Stat.A_start, hStOk := #ErrAnz);
IF #MB3441 THEN #DArbeitspl_tze_Zylinder.Weiche_Ausfahrt_MPS2.Stat.Ast := TRUE; END_IF;
IF #Schleuse_Ausfahrt.Dyn.Status.Trolley_draussen THEN #Vorfahrt_Ausfahrweiche."Weiche_von_Ausfahr-Sep_belegt" := FALSE; END_IF;
END_REGION
REGION Schleuse Hauptstrecke vor Ausfahrt
#Schleuse_vor_Ausfahrt(Schleusen_Nr := 3443, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3445, B_InSchleuse := #BG3443, B_AusSchleuse := #BG3444, B_Stau_raus := #DArbeitspl_tze_Sensoren.Stau_nach_Ausfahrt_MPS2.Stat.B_Akt, Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0105, Antrieb_plus_aktiv := #MA0112, Schleuse_geöffnet := #MB3443, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Vor_Ausfahrt_MPS2.Stat.Ast, Error := %DB608.DBW324, Antrieb_Schleuse_vor := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_vor, Antrieb_Schleuse_start := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_start, Antrieb_Schleuse_stop := #DArbeitspl_tze_Antriebe.MA0105.Stat.Stop_vor, Antrieb_Schleuse_PS := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_PS, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe.MA0112.Stat.A_vor, Antrieb_plus_start := #DArbeitspl_tze_Antriebe.MA0112.Stat.A_start, hStOk := #ErrAnz);
IF #MB3443 THEN #DArbeitspl_tze_Zylinder.Weiche_Ausfahrt_MPS2.Stat.Ast := FALSE; END_IF;
IF #Schleuse_vor_Ausfahrt.Dyn.Status.Trolley_draussen THEN #Vorfahrt_Ausfahrweiche."Weiche_von_Haupt-Sep_belegt" := FALSE; END_IF;
END_REGION
REGION Ausfahr-Priorität
#Prio_Ausfahrt(BG_Haupt_Schleuse := #BG3443, Haupt_Schleuse_geöffnet := #MB3443, BG_ABP_Schleuse := #BG3441, ABP_Schleuse_geöffnet := #MB3441, Aktive_ABP := #DPS5_OmniFahren.Aktivierte_ABPs);
END_REGION
REGION Störungen anzeigen
IF #ErrAnz THEN
#ErrAnz := FALSE;
#DAMR_Bereich.A01_UZ0602.StOk_blinken := TRUE;
END_IF;
END_REGION
REGION Ende
RETURN;
END_REGION
END_FUNCTION_BLOCK