Diff: gseDecode.c

Revision:

0:230c10b228ea

Child:

1:9399d44c2b1a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/gseDecode.c	Fri Oct 07 13:41:08 2011 +0000
@@ -0,0 +1,277 @@
+#include "gseDecodeBasic.h"
+#include "ied.h"
+#include "gseDecode.h"
+
+
+
+int ber_decode_myAnalogValue(unsigned char *buf, struct myAnalogValue *myAnalogValue) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_FLOAT32(&buf[offset], &myAnalogValue->f);
+    }
+
+    return offset;
+}
+int ber_decode_ScaledValueConfig(unsigned char *buf, struct ScaledValueConfig *ScaledValueConfig) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_FLOAT32(&buf[offset], &ScaledValueConfig->scaleFactor);
+        offset += BER_DECODE_CTYPE_FLOAT32(&buf[offset], &ScaledValueConfig->offset);
+    }
+
+    return offset;
+}
+int ber_decode_myVector(unsigned char *buf, struct myVector *myVector) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myAnalogValue(&buf[offset], &myVector->mag);
+        offset += ber_decode_myAnalogValue(&buf[offset], &myVector->ang);
+    }
+
+    return offset;
+}
+int ber_decode_simpleVector(unsigned char *buf, struct simpleVector *simpleVector) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myAnalogValue(&buf[offset], &simpleVector->mag);
+        offset += ber_decode_myAnalogValue(&buf[offset], &simpleVector->ang);
+    }
+
+    return offset;
+}
+int ber_decode_myMod(unsigned char *buf, struct myMod *myMod) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myMod->ctlVal);
+        offset += BER_DECODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myMod->stVal);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &myMod->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &myMod->t);
+    }
+
+    return offset;
+}
+int ber_decode_myHealth(unsigned char *buf, struct myHealth *myHealth) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myHealth->stVal);
+    }
+
+    return offset;
+}
+int ber_decode_myBeh(unsigned char *buf, struct myBeh *myBeh) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myBeh->stVal);
+    }
+
+    return offset;
+}
+int ber_decode_myINS(unsigned char *buf, struct myINS *myINS) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_INT32(&buf[offset], &myINS->stVal);
+    }
+
+    return offset;
+}
+int ber_decode_myLPL(unsigned char *buf, struct myLPL *myLPL) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_VISSTRING255(&buf[offset], &myLPL->ldNs);
+        offset += BER_DECODE_CTYPE_VISSTRING255(&buf[offset], &myLPL->configRev);
+    }
+
+    return offset;
+}
+int ber_decode_myDPL(unsigned char *buf, struct myDPL *myDPL) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_VISSTRING255(&buf[offset], &myDPL->vendor);
+        offset += BER_DECODE_CTYPE_VISSTRING255(&buf[offset], &myDPL->hwRev);
+    }
+
+    return offset;
+}
+int ber_decode_myPos(unsigned char *buf, struct myPos *myPos) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_DBPOS(&buf[offset], &myPos->stVal);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &myPos->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &myPos->t);
+        offset += BER_DECODE_CTYPE_BOOLEAN(&buf[offset], &myPos->ctlVal);
+    }
+
+    return offset;
+}
+int ber_decode_mySPS(unsigned char *buf, struct mySPS *mySPS) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_INT32(&buf[offset], &mySPS->stVal);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &mySPS->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &mySPS->t);
+    }
+
+    return offset;
+}
+int ber_decode_myMV(unsigned char *buf, struct myMV *myMV) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myAnalogValue(&buf[offset], &myMV->mag);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &myMV->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &myMV->t);
+        offset += ber_decode_ScaledValueConfig(&buf[offset], &myMV->sVC);
+    }
+
+    return offset;
+}
+int ber_decode_simpleMV(unsigned char *buf, struct simpleMV *simpleMV) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += BER_DECODE_CTYPE_FLOAT32(&buf[offset], &simpleMV->mag);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &simpleMV->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &simpleMV->t);
+        offset += ber_decode_ScaledValueConfig(&buf[offset], &simpleMV->sVC);
+    }
+
+    return offset;
+}
+int ber_decode_simpleCMV(unsigned char *buf, struct simpleCMV *simpleCMV) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_simpleVector(&buf[offset], &simpleCMV->cVal);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &simpleCMV->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &simpleCMV->t);
+    }
+
+    return offset;
+}
+int ber_decode_simpleWYE(unsigned char *buf, struct simpleWYE *simpleWYE) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_simpleCMV(&buf[offset], &simpleWYE->phsA);
+        offset += ber_decode_simpleCMV(&buf[offset], &simpleWYE->phsB);
+        offset += ber_decode_simpleCMV(&buf[offset], &simpleWYE->phsC);
+    }
+
+    return offset;
+}
+int ber_decode_myCMV(unsigned char *buf, struct myCMV *myCMV) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myVector(&buf[offset], &myCMV->cVal);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &myCMV->q);
+        offset += BER_DECODE_CTYPE_TIMESTAMP(&buf[offset], &myCMV->t);
+    }
+
+    return offset;
+}
+int ber_decode_mySEQ(unsigned char *buf, struct mySEQ *mySEQ) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myCMV(&buf[offset], &mySEQ->c1);
+        offset += ber_decode_myCMV(&buf[offset], &mySEQ->c2);
+        offset += ber_decode_myCMV(&buf[offset], &mySEQ->c3);
+        offset += BER_DECODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &mySEQ->seqT);
+    }
+
+    return offset;
+}
+int ber_decode_mySAV(unsigned char *buf, struct mySAV *mySAV) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myAnalogValue(&buf[offset], &mySAV->instMag);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &mySAV->q);
+    }
+
+    return offset;
+}
+int ber_decode_simpleSAV(unsigned char *buf, struct simpleSAV *simpleSAV) {
+    int offset = 0;
+
+    if (buf[offset++] == 0xA2) {
+        offset += getLengthFieldSize(buf[offset]);
+
+        offset += ber_decode_myAnalogValue(&buf[offset], &simpleSAV->instMag);
+        offset += BER_DECODE_CTYPE_QUALITY(&buf[offset], &simpleSAV->q);
+    }
+
+    return offset;
+}
+int ber_decode_Positions_RSYN_1(unsigned char *buf) {
+    int offset = 0;
+
+    offset += ber_decode_myAnalogValue(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.gse_inputs.instMag_1);
+    offset += ber_decode_myPos(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.gse_inputs.Pos_1);
+    offset += ber_decode_myPos(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.gse_inputs.Pos_2);
+    offset += BER_DECODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &D1Q1SB4.S1.C1.RSYN_1.gse_inputs.stVal_1);
+    offset += ber_decode_myMV(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.gse_inputs.Amps_1);
+    offset += ber_decode_myMV(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.gse_inputs.Volts_1);
+
+    return offset;
+}
+
+void gseDecodeDataset(unsigned char *dataset, int datasetLength, unsigned char *datSet, int datSetLength) {
+
+    if (strncmp((const char *) datSet, "E1Q1SB1C1/LLN0$Positions", datSetLength) == 0) {
+        ber_decode_Positions_RSYN_1(dataset);
+    }
+}
+
+