UH07 Original .awl Bausteine von Andi importiert
This commit is contained in:
@@ -1,204 +1,248 @@
|
||||
=== FC 82: FifoReset [STL] ===
|
||||
INTERFACE:
|
||||
Input:
|
||||
SSDB : Int // Schnittstellen-DB
|
||||
SSDW : Int // Schnittstellen-1.DW
|
||||
PARA : Word // Aufrufparameter (Durchlaufspeicher?)
|
||||
Output:
|
||||
RE_VAL : Byte // Rückmeldung
|
||||
InOut:
|
||||
Temp:
|
||||
Quelle : Any // Zeiger, wo Rein-Daten sind
|
||||
Kopf : Byte // Fifo-Kennung (FF)
|
||||
Datensatzlaenge : Byte // Datensatzlänge in Word (1 - 128)
|
||||
FifoLaenge : Int // Länge des Fifo (maximale Anzahl der Datensätze)
|
||||
Bringzeiger : Int // Zeiger, wohin nächster Eintrag gespeichert wird
|
||||
Holzeiger : Int // Zeiger, woher nächste Daten geholt werden
|
||||
Anzahl : Int // Anzahl der Datensätze (eingetragene)
|
||||
Status : Word // Status des Fifo
|
||||
DBFifo : Word // FIFO-DB
|
||||
SFC_RET_VAL : Int // Rückmeldung SFC-Aufruf
|
||||
SFC_DB_LENGTH : Word // Rückmeldung SFC-Aufruf
|
||||
Fifo_Ende : Word // Ende des Fifo
|
||||
Schleife : Word // Loopzähler
|
||||
SFC_WRITE_PROT : Bool // Rückmeldung SFC-Aufruf
|
||||
Constant:
|
||||
Return:
|
||||
Ret_Val : Void
|
||||
FUNCTION "FifoReset" : Void
|
||||
TITLE = Fifo-Modul
|
||||
{ S7_Optimized_Access := 'FALSE' }
|
||||
AUTHOR : IBAE
|
||||
FAMILY : FIFO
|
||||
NAME : FifoIn
|
||||
VERSION : 0.1
|
||||
//COPYRIGHT by Ingenieurbüro A.Emmert
|
||||
//Ortsstr.33, D-869925 Fuchstal (Germany)
|
||||
//Tel.: 0049(0)8243-1254
|
||||
//Version: ILS2100 / 06.11.2009
|
||||
//
|
||||
//Fifo resetten
|
||||
//SSDB: FIFO-DB
|
||||
//SSDW: FIFO-1.DW
|
||||
//PARA: Aufrufparameter 00XX:
|
||||
// XX: 00 = Normaler FIFO (alles löschen)
|
||||
// D0 = Durchlaufspeicher (alles mit Nullen füllen)
|
||||
// D1 = Durchlaufspeicher (alles mit FFFF füllen)
|
||||
// Rückmeldungen:
|
||||
// Bit0: Kein Fifobereich / falscher Kopfinhalt / Endekennung
|
||||
// Bit1: SFC20-Aufruf mit Fehler
|
||||
// Bit2: Frei
|
||||
// Bit3: Frei
|
||||
// Bit4: Frei
|
||||
// Bit5: Frei
|
||||
// Bit6: Frei
|
||||
// Bit7: Frei
|
||||
//
|
||||
VAR_INPUT
|
||||
SSDB : Int; // Schnittstellen-DB
|
||||
SSDW : Int; // Schnittstellen-1.DW
|
||||
PARA : Word; // Aufrufparameter (Durchlaufspeicher?)
|
||||
END_VAR
|
||||
|
||||
--- NW 1: Schnittstellen-DB sinnvoll ? ---
|
||||
L SSDB
|
||||
T DBFifo
|
||||
VAR_OUTPUT
|
||||
RE_VAL : Byte; // Rückmeldung
|
||||
END_VAR
|
||||
|
||||
// CALL TEST_DB
|
||||
// DB_NUMBER :=#DBFifo
|
||||
// RET_VAL :=#SFC_RET_VAL
|
||||
// DB_LENGTH :=#SFC_DB_LENGTH
|
||||
// WRITE_PROT :=#SFC_WRITE_PROT
|
||||
|
||||
CALL FC "TEST_DB_TO_ATTR_DB" (DB_Number:=DBFifo, RetVal:=SFC_RET_VAL, DB_Length:=SFC_DB_LENGTH, Write_Prot:=SFC_WRITE_PROT)
|
||||
|
||||
L SFC_RET_VAL
|
||||
L 2#0000_0000_0000_0000
|
||||
<>I
|
||||
O SFC_WRITE_PROT
|
||||
JC Err0 // kein Fifobereich
|
||||
VAR_TEMP
|
||||
Quelle : Any; // Zeiger, wo Rein-Daten sind
|
||||
Kopf : Byte; // Fifo-Kennung (FF)
|
||||
Datensatzlaenge : Byte; // Datensatzlänge in Word (1 - 128)
|
||||
FifoLaenge : Int; // Länge des Fifo (maximale Anzahl der Datensätze)
|
||||
Bringzeiger : Int; // Zeiger, wohin nächster Eintrag gespeichert wird
|
||||
Holzeiger : Int; // Zeiger, woher nächste Daten geholt werden
|
||||
Anzahl : Int; // Anzahl der Datensätze (eingetragene)
|
||||
Status : Word; // Status des Fifo
|
||||
DBFifo : Word; // FIFO-DB
|
||||
SFC_RET_VAL : Int; // Rückmeldung SFC-Aufruf
|
||||
SFC_DB_LENGTH : Word; // Rückmeldung SFC-Aufruf
|
||||
Fifo_Ende : Word; // Ende des Fifo
|
||||
Schleife : Word; // Loopzähler
|
||||
SFC_WRITE_PROT : Bool; // Rückmeldung SFC-Aufruf
|
||||
END_VAR
|
||||
|
||||
|
||||
--- NW 2: Quelle-Pointer erzeugen: ---
|
||||
L 16#1004 // Kennung 10 + Word=04
|
||||
T LW0 // Any-Kennung, Datentyp
|
||||
L 16#0006 // 6 Dw´s holen
|
||||
T LW2 // Wiederholungen
|
||||
L SSDB
|
||||
T LW4 // DB_Nummer
|
||||
L SSDW // Adresse
|
||||
SLD 3
|
||||
L 16#8400_0000 // Kennung: Daten
|
||||
OD
|
||||
T LD6 // Kennung, Adresse
|
||||
BEGIN
|
||||
NETWORK
|
||||
TITLE = Schnittstellen-DB sinnvoll ?
|
||||
L #SSDB;
|
||||
T #DBFifo;
|
||||
|
||||
CALL SYS "BLKMOV" (SRCBLK:=Quelle, RET_VAL:=SFC_RET_VAL, DSTBLK:=P#L10.0 WORD 6) // 1.-6.DW FIFO holen
|
||||
// CALL TEST_DB
|
||||
// DB_NUMBER :=#DBFifo
|
||||
// RET_VAL :=#SFC_RET_VAL
|
||||
// DB_LENGTH :=#SFC_DB_LENGTH
|
||||
// WRITE_PROT :=#SFC_WRITE_PROT
|
||||
|
||||
L SFC_RET_VAL
|
||||
L 2#0000_0000_0000_0000
|
||||
<>I
|
||||
JC Err1
|
||||
CALL "TEST_DB_TO_ATTR_DB"
|
||||
( DB_Number := #DBFifo ,
|
||||
RetVal := #SFC_RET_VAL ,
|
||||
DB_Length := #SFC_DB_LENGTH ,
|
||||
Write_Prot := #SFC_WRITE_PROT
|
||||
);
|
||||
|
||||
L #SFC_RET_VAL;
|
||||
L 2#0000_0000_0000_0000;
|
||||
<>I;
|
||||
O #SFC_WRITE_PROT;
|
||||
SPB Err0;//kein Fifobereich
|
||||
|
||||
NETWORK
|
||||
TITLE = Fifokopfdaten holen
|
||||
//Quelle-Pointer erzeugen:
|
||||
L 16#1004;//Kennung 10 + Word=04
|
||||
T %LW0;//Any-Kennung, Datentyp
|
||||
L 16#0006;//6 Dw´s holen
|
||||
T %LW2;//Wiederholungen
|
||||
L #SSDB;
|
||||
T %LW4;//DB_Nummer
|
||||
L #SSDW;//Adresse
|
||||
SLD 3;
|
||||
L 16#8400_0000;//Kennung: Daten
|
||||
OD;
|
||||
T %LD6;//Kennung, Adresse
|
||||
|
||||
CALL BLKMOV//1.-6.DW FIFO holen
|
||||
{blk_type := 'Variant'}
|
||||
( SRCBLK := #Quelle ,
|
||||
RET_VAL := #SFC_RET_VAL ,
|
||||
DSTBLK := P#L10.0 WORD 6
|
||||
);
|
||||
|
||||
L #SFC_RET_VAL;
|
||||
L 2#0000_0000_0000_0000;
|
||||
<>I;
|
||||
SPB Err1;
|
||||
|
||||
NETWORK
|
||||
TITLE = Zeigerüberprüfung
|
||||
L #Kopf;//Fifo-Kopf
|
||||
L 16#FF;//= Fifokennung ?
|
||||
<>I;//Nein !
|
||||
SPB Err0;//kein Fifobereich
|
||||
|
||||
L 1;
|
||||
L #Datensatzlaenge;//Datenblocklänge
|
||||
>I;
|
||||
SPB Err0;//kein Fifobereich
|
||||
|
||||
L 128;
|
||||
>I;
|
||||
SPB Err0;//kein Fifobereich
|
||||
|
||||
L 1;
|
||||
L #FifoLaenge;//Max.Anzahl von Datenblöcken
|
||||
>I;
|
||||
SPB Err0;//kein Fifobereich
|
||||
|
||||
L #FifoLaenge;//Länge FIFO (in Word)
|
||||
L #Datensatzlaenge;//Datenblocklänge
|
||||
*I;
|
||||
L 2;//DB byteorientiert
|
||||
*I;
|
||||
+ 40;//Speichern ab 20.DW
|
||||
L #SSDW;
|
||||
+I;
|
||||
T #Fifo_Ende;
|
||||
SLW 3;//Pointer erzeugen
|
||||
LAR1;
|
||||
|
||||
AUF DB[ #DBFifo];
|
||||
|
||||
L #Fifo_Ende;
|
||||
L #SFC_DB_LENGTH;
|
||||
>I;//Fifo-DB ist zu kurz!
|
||||
SPB Err0;//kein Fifo-Bereich
|
||||
|
||||
L DBW[ AR1, P#0.0];
|
||||
L 16#FFEE;//Fifo-Endekennung ?
|
||||
<>I;//Nein !
|
||||
SPB Err0;//kein Fifobereich
|
||||
|
||||
NETWORK
|
||||
TITLE = Fifo-Daten löschen
|
||||
L #SSDW;
|
||||
+ 4;//Ab 2.Dw
|
||||
SLW 3;//Pointer erzeugen
|
||||
LAR1;
|
||||
|
||||
AUF DB[ #DBFifo];
|
||||
|
||||
L #Datensatzlaenge;
|
||||
L #FifoLaenge;
|
||||
*I;
|
||||
+ 18;//18 Datenwörter (wortorientiert)
|
||||
L400: T #Schleife;
|
||||
|
||||
L 0;
|
||||
T DBW[ AR1, P#0.0];
|
||||
|
||||
+AR1 P#2.0;
|
||||
|
||||
L #Schleife;
|
||||
LOOP L400;
|
||||
|
||||
|
||||
--- NW 3: Zeigerüberprüfung ---
|
||||
L Kopf // Fifo-Kopf
|
||||
L 16#FF // = Fifokennung ?
|
||||
<>I // Nein !
|
||||
JC Err0 // kein Fifobereich
|
||||
NETWORK
|
||||
TITLE = Durchlaufspeicher ?
|
||||
L #PARA;//Aufrufparameter
|
||||
SRW 4;
|
||||
L 16#000D;//Durchlaufspeicher ?
|
||||
<>I;//Nein !
|
||||
SPB N006;
|
||||
|
||||
L 1
|
||||
L Datensatzlaenge // Datenblocklänge
|
||||
>I
|
||||
JC Err0 // kein Fifobereich
|
||||
L #SSDW;
|
||||
+ 4;//Speichern ab 4.DW
|
||||
SLW 3;//Pointer erzeugen
|
||||
LAR1;
|
||||
|
||||
L 128
|
||||
>I
|
||||
JC Err0 // kein Fifobereich
|
||||
AUF DB[ #DBFifo];
|
||||
|
||||
L 1
|
||||
L FifoLaenge // Max.Anzahl von Datenblöcken
|
||||
>I
|
||||
JC Err0 // kein Fifobereich
|
||||
L #SSDW;
|
||||
+ 40;//1.Speicherzelle
|
||||
T DBW[ AR1, P#0.0];//Bringzeiger
|
||||
T DBW[ AR1, P#2.0];//Holzeiger
|
||||
|
||||
L FifoLaenge // Länge FIFO (in Word)
|
||||
L Datensatzlaenge // Datenblocklänge
|
||||
*I
|
||||
L 2 // DB byteorientiert
|
||||
*I
|
||||
+ 40 // Speichern ab 20.DW
|
||||
L SSDW
|
||||
+I
|
||||
T Fifo_Ende
|
||||
SLW 3 // Pointer erzeugen
|
||||
LAR1
|
||||
L #FifoLaenge;//Fifo ist voll
|
||||
T DBW[ AR1, P#4.0];//Anzahl
|
||||
|
||||
OPN DB[DBFifo]
|
||||
L #PARA;//Aufrufparameter
|
||||
L 16#00D1;//Durchlaufspeicher mit FFFF füllen
|
||||
<>I;//Nein !
|
||||
SPB N006;
|
||||
|
||||
L Fifo_Ende
|
||||
L SFC_DB_LENGTH
|
||||
>I // Fifo-DB ist zu kurz!
|
||||
JC Err0 // kein Fifo-Bereich
|
||||
L #FifoLaenge;//Fifo ist voll
|
||||
T DBW[ AR1, P#8.0];//1.Zusatz-Dw (Anzahl der Daten)
|
||||
|
||||
L DBW [AR1,]
|
||||
L 16#FFEE // Fifo-Endekennung ?
|
||||
<>I // Nein !
|
||||
JC Err0 // kein Fifobereich
|
||||
L 2#0000_0000_0000_0011;//Daten vorhanden/kommen raus
|
||||
T DBW[ AR1, P#14.0];//4.Zusatz-Dw (Status)
|
||||
|
||||
L #SSDW;
|
||||
+ 40;//Ab 20.Dw
|
||||
SLW 3;//Pointer erzeugen
|
||||
LAR1;
|
||||
|
||||
--- NW 4: Fifo-Daten löschen ---
|
||||
L SSDW
|
||||
+ 4 // Ab 2.Dw
|
||||
SLW 3 // Pointer erzeugen
|
||||
LAR1
|
||||
AUF DB[ #DBFifo];
|
||||
|
||||
OPN DB[DBFifo]
|
||||
L #Datensatzlaenge;
|
||||
L #FifoLaenge;
|
||||
*I;
|
||||
L500: T #Schleife;
|
||||
|
||||
L Datensatzlaenge
|
||||
L FifoLaenge
|
||||
*I
|
||||
+ 18 // 18 Datenwörter (wortorientiert)
|
||||
L400: T Schleife
|
||||
L 16#FFFF;
|
||||
T DBW[ AR1, P#0.0];
|
||||
|
||||
L 0
|
||||
T DBW [AR1,]
|
||||
+AR1 P#2.0;
|
||||
|
||||
ADDAR1 P#2.0
|
||||
L #Schleife;
|
||||
LOOP L500;
|
||||
|
||||
L Schleife
|
||||
LOOP L400
|
||||
NETWORK
|
||||
TITLE = Fehlerausgabe / RET_VAL
|
||||
N006: SET;//VKE = 1 ohne Fehler !!!
|
||||
L 2#0000_0000_0000_0000;
|
||||
SPA Ok;
|
||||
Err0: L 2#0000_0000_0000_0001;//Kein Fifobereich
|
||||
SPA Err;
|
||||
Err1: L 2#0000_0000_0000_0010;//SFC20-Aufruf mit Fehler
|
||||
|
||||
Err: CLR;//VKE = 0 bei Fehler !!!
|
||||
Ok: T #RE_VAL;
|
||||
|
||||
SAVE;//VKE in BIE-Bit speichern
|
||||
|
||||
--- NW 5: Durchlaufspeicher ? ---
|
||||
L PARA // Aufrufparameter
|
||||
SRW 4
|
||||
L 16#000D // Durchlaufspeicher ?
|
||||
<>I // Nein !
|
||||
JC N006
|
||||
|
||||
L SSDW
|
||||
+ 4 // Speichern ab 4.DW
|
||||
SLW 3 // Pointer erzeugen
|
||||
LAR1
|
||||
|
||||
OPN DB[DBFifo]
|
||||
|
||||
L SSDW
|
||||
+ 40 // 1.Speicherzelle
|
||||
T DBW [AR1,] // Bringzeiger
|
||||
T DBW [AR1,] // Holzeiger
|
||||
|
||||
L FifoLaenge // Fifo ist voll
|
||||
T DBW [AR1,] // Anzahl
|
||||
|
||||
L PARA // Aufrufparameter
|
||||
L 16#00D1 // Durchlaufspeicher mit FFFF füllen
|
||||
<>I // Nein !
|
||||
JC N006
|
||||
|
||||
L FifoLaenge // Fifo ist voll
|
||||
T DBW [AR1,] // 1.Zusatz-Dw (Anzahl der Daten)
|
||||
|
||||
L 2#0000_0000_0000_0011 // Daten vorhanden/kommen raus
|
||||
T DBW [AR1,] // 4.Zusatz-Dw (Status)
|
||||
|
||||
L SSDW
|
||||
+ 40 // Ab 20.Dw
|
||||
SLW 3 // Pointer erzeugen
|
||||
LAR1
|
||||
|
||||
OPN DB[DBFifo]
|
||||
|
||||
L Datensatzlaenge
|
||||
L FifoLaenge
|
||||
*I
|
||||
L500: T Schleife
|
||||
|
||||
L 16#FFFF
|
||||
T DBW [AR1,]
|
||||
|
||||
ADDAR1 P#2.0
|
||||
|
||||
L Schleife
|
||||
LOOP L500
|
||||
|
||||
|
||||
--- NW 6: Fehlerausgabe / RET_VAL ---
|
||||
N006: SET // VKE = 1 ohne Fehler !!!
|
||||
L 2#0000_0000_0000_0000
|
||||
JU Ok
|
||||
Err0: L 2#0000_0000_0000_0001 // Kein Fifobereich
|
||||
JU Err
|
||||
Err1: L 2#0000_0000_0000_0010 // SFC20-Aufruf mit Fehler
|
||||
|
||||
Err: CLR // VKE = 0 bei Fehler !!!
|
||||
Ok: T RE_VAL
|
||||
|
||||
SAVE // VKE in BIE-Bit speichern
|
||||
END_FUNCTION
|
||||
|
||||
|
||||
Reference in New Issue
Block a user