176 lines
14 KiB
Plaintext
176 lines
14 KiB
Plaintext
FUNCTION_BLOCK "MPS3_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
|
|
PF0052 : Word; // war "PF0052"
|
|
PF3384 : Word; // war "PF3384"
|
|
END_VAR
|
|
|
|
VAR_IN_OUT
|
|
BG3384 : Word; // war "BG3384"
|
|
BG3390 : Word; // war "BG3390"
|
|
BG3391 : Word; // war "BG3391"
|
|
BG3392 : Word; // war "BG3392"
|
|
BG3393 : Word; // war "BG3393"
|
|
BG3395 : Word; // war "BG3395"
|
|
BG3401 : Word; // war "BG3401"
|
|
BG3405 : Word; // war "BG3405"
|
|
BG3410 : Word; // war "BG3410"
|
|
BG3411 : Word; // war "BG3411"
|
|
BG3413 : Word; // war "BG3413"
|
|
BG3414 : Word; // war "BG3414"
|
|
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"
|
|
MA0095 : Bool; // war "MA0095"
|
|
MA0096 : Bool; // war "MA0096"
|
|
MA0097 : Bool; // war "MA0097"
|
|
MA0100 : Bool; // war "MA0100"
|
|
MA0105 : Bool; // war "MA0105"
|
|
MB3390 : Byte; // war "MB3390"
|
|
MB3392 : Byte; // war "MB3392"
|
|
MB3393 : Byte; // war "MB3393"
|
|
MB3395 : Byte; // war "MB3395"
|
|
MB3401 : Byte; // war "MB3401"
|
|
MB3405 : Byte; // war "MB3405"
|
|
MB3411 : Byte; // war "MB3411"
|
|
MB3413 : Byte; // war "MB3413"
|
|
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_UZ0603.StOk_aktiv;
|
|
IF #DAMR_Bereich.A01_UZ0603.StOk_aktiv THEN
|
|
#DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.A_start := TRUE;
|
|
#DArbeitspl_tze_Antriebe."MA _Nachstau1_MPS3".Stat.A_start := TRUE;
|
|
#DArbeitspl_tze_Antriebe."MA _Nachstau2_MPS3".Stat.A_start := TRUE;
|
|
#DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".Stat.A_start := TRUE;
|
|
#DArbeitspl_tze_Antriebe.MA0105.Stat.A_start := TRUE;
|
|
END_IF;
|
|
END_REGION
|
|
|
|
REGION Schleuse vor Einfahrt
|
|
#Schleuse_vor_Einfahrt(Schleusen_Nr := 3390, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3384, B_InSchleuse := #BG3390, B_AusSchleuse := , B_Stau_raus := , Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0105, Antrieb_plus_aktiv := 1, Schleuse_geöffnet := #MB3390, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Vor_Einfahrt_MPS3.Stat.Ast, Error := %DB608.DBW294, 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 := 3392, ErrQuit := #ErrQuit, Fahren_Ok := 1, B_Ziel_gerade := #DArbeitspl_tze_Sensoren.Stau_nach_Einfahrt_MPS3.Stat.B_Akt, B_Ziel_abzweig := #DArbeitspl_tze_Sensoren.Stau_Einfahrt_MPS3.Stat.B_Akt, Antrieb_Weiche_aktiv := #MA0105, Antrieb_Gerade_aktiv := #MA0105, Antrieb_Abzweig_aktiv := #MA0095, Weiche_ist_AST := #MB3392, Y_Weiche_abzweig := #DArbeitspl_tze_Zylinder.Weiche_Einfahrt_MPS3.Stat.Ast, Error := %DB608.DBW296, 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_MPS3".Stat.A_vor, Antrieb_Weiche_abzweig_stop := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.Stop_vor, hStOk := #ErrAnz); // s.o. | s.o.
|
|
END_REGION
|
|
|
|
REGION Schrittketten Arbeitsplätze ver-/entsorgen
|
|
#Sks_Arbeitsplatz(Arbeitsplatz_Nr := 16#B300, ErrQuit := #ErrQuit, B_In_Schleuse_Vorstau := #BG3393, B_an_Platz_1 := #BG3395, B_an_Platz_2 := #BG3401, B_an_Platz_3 := #BG3405, B_Nachstau_Einfahrt := #DArbeitspl_tze_Sensoren.Stau_Ausfahrt_MPS3.Stat.B_Akt, B_Nachstau_Ausfahrt := #BG3411, Y_Vorstau := #MB3393, Y_Platz_1 := #MB3395, Y_Platz_2 := #MB3401, Y_Platz_3 := #MB3405, Antrieb_Vorstau_aktiv := #MA0095, Antrieb_Nachstau_1_aktiv := #MA0096, Antrieb_Nachstau_2_aktiv := #MA0097, Antrieb_Nachstau_3_aktiv := #MA0100, Y_Weiche_zu_Platz_1 := #DArbeitspl_tze_Zylinder.Weiche_zu_Platz1_MPS3.Stat.Ast, Y_Weiche_zu_Platz_2 := #DArbeitspl_tze_Zylinder.Weiche_zu_Platz2_MPS3.Stat.Ast, Y_Weiche_von_Platz_1 := #DArbeitspl_tze_Zylinder.Weiche_von_Platz1_MPS3.Stat.Ast, Y_Weiche_von_Platz_2 := #DArbeitspl_tze_Zylinder.Weiche_von_Platz2_MPS3.Stat.Ast, Antrieb_Nachstau_1_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau1_MPS3".Stat.A_vor, Antrieb_Nachstau_2_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau2_MPS3".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.DBW114, Antrieb_Vorstau_vor := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.A_vor, Antrieb_Nachstau_3_vor := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".Stat.A_vor, hStOk := #ErrAnz); // XY00: X=A(PS), X=B(MPS), Y= Nummer des Platzes
|
|
#PF0052 := #DAMR_Bereich.A01_UH06.AnlageEin AND #Sks_Arbeitsplatz.Dyn.Status.Arbeitsplatz_aktiviert;
|
|
#PF3384 := #Sks_Arbeitsplatz.Dyn.SS.Externe_Anzeige;
|
|
END_REGION
|
|
|
|
REGION Schleuse Vorstau
|
|
#Schleuse_Vorstau(Schleusen_Nr := 3393, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3392, B_InSchleuse := #BG3393, Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0095, Antrieb_plus_aktiv := 1, Schleuse_geöffnet := #MB3393, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Vorstau_MPS3.Stat.Ast, Error := %DB608.DBW298, Antrieb_Schleuse_vor := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.A_vor, Antrieb_Schleuse_start := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.A_start, Antrieb_Schleuse_stop := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.Stop_vor, Antrieb_Schleuse_PS := #DArbeitspl_tze_Antriebe."MA _Einfahrt_MPS3".Stat.A_PS, hStOk := #ErrAnz);
|
|
END_REGION
|
|
|
|
REGION Schleuse Platz 1
|
|
#Schleuse_Platz_1(Schleusen_Nr := 3395, ErrQuit := #ErrQuit, B_InSchleuse := #BG3395, Start_Ok := 1, Antrieb_Schleuse_aktiv := 1, Antrieb_plus_aktiv := #MA0096, Schleuse_geöffnet := #MB3395, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Platz1_MPS3.Stat.Ast, Error := %DB608.DBW300, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau1_MPS3".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 := 3401, ErrQuit := #ErrQuit, B_InSchleuse := #BG3401, Start_Ok := 1, Antrieb_Schleuse_aktiv := 1, Antrieb_plus_aktiv := #MA0097, Schleuse_geöffnet := #MB3401, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Platz2_MPS3.Stat.Ast, Error := %DB608.DBW302, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe."MA _Nachstau2_MPS3".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 := 3405, ErrQuit := #ErrQuit, B_InSchleuse := #BG3405, Start_Ok := 1, Antrieb_Schleuse_aktiv := 1, Antrieb_plus_aktiv := #MA0100, Schleuse_geöffnet := #MB3405, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Platz3_MPS3.Stat.Ast, Error := %DB608.DBW304, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".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 := 3411, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3410, B_InSchleuse := #BG3411, B_AusSchleuse := #BG3414, B_Stau_raus := #DArbeitspl_tze_Sensoren.Stau_nach_Ausfahrt_MPS3.Stat.B_Akt, Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0100, Antrieb_plus_aktiv := #MA0105, Schleuse_geöffnet := #MB3411, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Ausfahrt_MPS3.Stat.Ast, Error := %DB608.DBW306, Antrieb_Schleuse_vor := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".Stat.A_vor, Antrieb_Schleuse_start := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".Stat.A_start, Antrieb_Schleuse_stop := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".Stat.Stop_vor, Antrieb_Schleuse_PS := #DArbeitspl_tze_Antriebe."MA _Ausfahrt_MPS3".Stat.A_PS, Antrieb_plus_vor := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_vor, Antrieb_plus_start := #DArbeitspl_tze_Antriebe.MA0105.Stat.A_start, hStOk := #ErrAnz);
|
|
IF #MB3411 THEN #DArbeitspl_tze_Zylinder.Weiche_Ausfahrt_MPS3.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 := 3413, ErrQuit := #ErrQuit, B_VorSchleuse := #BG3391, B_InSchleuse := #BG3413, B_AusSchleuse := #BG3414, B_Stau_raus := #DArbeitspl_tze_Sensoren.Stau_nach_Ausfahrt_MPS3.Stat.B_Akt, Start_Ok := 1, Antrieb_Schleuse_aktiv := #MA0105, Antrieb_plus_aktiv := #MA0105, Schleuse_geöffnet := #MB3413, Y_Schleuse_Auf := #DArbeitspl_tze_Zylinder.Schleuse_Vor_Ausfahrt_MPS3.Stat.Ast, Error := %DB608.DBW308, 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 := , Antrieb_plus_start := , hStOk := #ErrAnz); // s.o. | s.o.
|
|
IF #MB3413 THEN #DArbeitspl_tze_Zylinder.Weiche_Ausfahrt_MPS3.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 := #BG3413, Haupt_Schleuse_geöffnet := #MB3413, BG_ABP_Schleuse := #BG3411, ABP_Schleuse_geöffnet := #MB3411, Aktive_ABP := #DPS5_OmniFahren.Aktivierte_ABPs);
|
|
END_REGION
|
|
|
|
REGION Störungen anzeigen
|
|
IF #ErrAnz THEN
|
|
#ErrAnz := FALSE;
|
|
#DAMR_Bereich.A01_UZ0603.StOk_blinken := TRUE;
|
|
END_IF;
|
|
END_REGION
|
|
|
|
REGION Ende
|
|
RETURN;
|
|
END_REGION
|
|
|
|
END_FUNCTION_BLOCK
|