The goal of this software is to automatically generate C/C++ code which reads and writes GOOSE and Sampled Value packets. Any valid IEC 61850 Substation Configuration Description (SCD) file, describing GOOSE and/or SV communications, can be used as the input. The output code is lightweight and platform-independent, so it can run on a variety of devices, including low-cost microcontrollers. It\'s ideal for rapid-prototyping new protection and control systems that require communications. This mbed project is a simple example of this functionality. Other code: https://github.com/stevenblair/rapid61850 Project homepage: http://personal.strath.ac.uk/steven.m.blair/
Diff: gseEncode.c
- Revision:
- 1:9399d44c2b1a
- Parent:
- 0:230c10b228ea
--- a/gseEncode.c Fri Oct 07 13:41:08 2011 +0000 +++ b/gseEncode.c Fri Oct 07 13:48:18 2011 +0000 @@ -1,541 +1,561 @@ -#include "gseEncodeBasic.h" -#include "ied.h" +/** + * Rapid-prototyping protection schemes with IEC 61850 + * + * Copyright (c) 2011 Steven Blair + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. + */ + +#include "gseEncodeBasic.h" +#include "ied.h" #include "gseEncode.h" -int ber_get_length_myAnalogValue(struct myAnalogValue *myAnalogValue) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_FLOAT32(&myAnalogValue->f); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myAnalogValue(struct myAnalogValue *myAnalogValue) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_FLOAT32(&myAnalogValue->f); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myAnalogValue(unsigned char *buf, struct myAnalogValue *myAnalogValue) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myAnalogValue(myAnalogValue)); - - offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &myAnalogValue->f); - - return offset; +int ber_encode_myAnalogValue(unsigned char *buf, struct myAnalogValue *myAnalogValue) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myAnalogValue(myAnalogValue)); + + offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &myAnalogValue->f); + + return offset; } -int ber_get_length_ScaledValueConfig(struct ScaledValueConfig *ScaledValueConfig) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_FLOAT32(&ScaledValueConfig->scaleFactor); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_FLOAT32(&ScaledValueConfig->offset); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_ScaledValueConfig(struct ScaledValueConfig *ScaledValueConfig) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_FLOAT32(&ScaledValueConfig->scaleFactor); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_FLOAT32(&ScaledValueConfig->offset); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_ScaledValueConfig(unsigned char *buf, struct ScaledValueConfig *ScaledValueConfig) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_ScaledValueConfig(ScaledValueConfig)); - - offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &ScaledValueConfig->scaleFactor); - offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &ScaledValueConfig->offset); - - return offset; +int ber_encode_ScaledValueConfig(unsigned char *buf, struct ScaledValueConfig *ScaledValueConfig) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_ScaledValueConfig(ScaledValueConfig)); + + offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &ScaledValueConfig->scaleFactor); + offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &ScaledValueConfig->offset); + + return offset; } -int ber_get_length_myVector(struct myVector *myVector) { - int total = 0; - int len = 0; - - len = ber_get_length_myAnalogValue(&myVector->mag); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myAnalogValue(&myVector->ang); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myVector(struct myVector *myVector) { + int total = 0; + int len = 0; + + len = ber_get_length_myAnalogValue(&myVector->mag); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myAnalogValue(&myVector->ang); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myVector(unsigned char *buf, struct myVector *myVector) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myVector(myVector)); - - offset += ber_encode_myAnalogValue(&buf[offset], &myVector->mag); - offset += ber_encode_myAnalogValue(&buf[offset], &myVector->ang); - - return offset; +int ber_encode_myVector(unsigned char *buf, struct myVector *myVector) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myVector(myVector)); + + offset += ber_encode_myAnalogValue(&buf[offset], &myVector->mag); + offset += ber_encode_myAnalogValue(&buf[offset], &myVector->ang); + + return offset; } -int ber_get_length_simpleVector(struct simpleVector *simpleVector) { - int total = 0; - int len = 0; - - len = ber_get_length_myAnalogValue(&simpleVector->mag); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myAnalogValue(&simpleVector->ang); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_simpleVector(struct simpleVector *simpleVector) { + int total = 0; + int len = 0; + + len = ber_get_length_myAnalogValue(&simpleVector->mag); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myAnalogValue(&simpleVector->ang); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_simpleVector(unsigned char *buf, struct simpleVector *simpleVector) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_simpleVector(simpleVector)); - - offset += ber_encode_myAnalogValue(&buf[offset], &simpleVector->mag); - offset += ber_encode_myAnalogValue(&buf[offset], &simpleVector->ang); - - return offset; +int ber_encode_simpleVector(unsigned char *buf, struct simpleVector *simpleVector) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_simpleVector(simpleVector)); + + offset += ber_encode_myAnalogValue(&buf[offset], &simpleVector->mag); + offset += ber_encode_myAnalogValue(&buf[offset], &simpleVector->ang); + + return offset; } -int ber_get_length_myMod(struct myMod *myMod) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myMod->ctlVal); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myMod->stVal); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&myMod->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myMod->t); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myMod(struct myMod *myMod) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myMod->ctlVal); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myMod->stVal); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&myMod->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myMod->t); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myMod(unsigned char *buf, struct myMod *myMod) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myMod(myMod)); - - offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myMod->ctlVal); - offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myMod->stVal); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myMod->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myMod->t); - - return offset; +int ber_encode_myMod(unsigned char *buf, struct myMod *myMod) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myMod(myMod)); + + offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myMod->ctlVal); + offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myMod->stVal); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myMod->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myMod->t); + + return offset; } -int ber_get_length_myHealth(struct myHealth *myHealth) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myHealth->stVal); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myHealth(struct myHealth *myHealth) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myHealth->stVal); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myHealth(unsigned char *buf, struct myHealth *myHealth) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myHealth(myHealth)); - - offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myHealth->stVal); - - return offset; +int ber_encode_myHealth(unsigned char *buf, struct myHealth *myHealth) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myHealth(myHealth)); + + offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myHealth->stVal); + + return offset; } -int ber_get_length_myBeh(struct myBeh *myBeh) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myBeh->stVal); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myBeh(struct myBeh *myBeh) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &myBeh->stVal); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myBeh(unsigned char *buf, struct myBeh *myBeh) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myBeh(myBeh)); - - offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myBeh->stVal); - - return offset; +int ber_encode_myBeh(unsigned char *buf, struct myBeh *myBeh) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myBeh(myBeh)); + + offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &myBeh->stVal); + + return offset; } -int ber_get_length_myINS(struct myINS *myINS) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_INT32(&myINS->stVal); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myINS(struct myINS *myINS) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_INT32(&myINS->stVal); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myINS(unsigned char *buf, struct myINS *myINS) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myINS(myINS)); - - offset += BER_ENCODE_CTYPE_INT32(&buf[offset], &myINS->stVal); - - return offset; +int ber_encode_myINS(unsigned char *buf, struct myINS *myINS) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myINS(myINS)); + + offset += BER_ENCODE_CTYPE_INT32(&buf[offset], &myINS->stVal); + + return offset; } -int ber_get_length_myLPL(struct myLPL *myLPL) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myLPL->ldNs); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myLPL->configRev); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myLPL(struct myLPL *myLPL) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myLPL->ldNs); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myLPL->configRev); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myLPL(unsigned char *buf, struct myLPL *myLPL) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myLPL(myLPL)); - - offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myLPL->ldNs); - offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myLPL->configRev); - - return offset; +int ber_encode_myLPL(unsigned char *buf, struct myLPL *myLPL) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myLPL(myLPL)); + + offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myLPL->ldNs); + offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myLPL->configRev); + + return offset; } -int ber_get_length_myDPL(struct myDPL *myDPL) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myDPL->vendor); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myDPL->hwRev); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myDPL(struct myDPL *myDPL) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myDPL->vendor); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_VISSTRING255(&myDPL->hwRev); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myDPL(unsigned char *buf, struct myDPL *myDPL) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myDPL(myDPL)); - - offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myDPL->vendor); - offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myDPL->hwRev); - - return offset; +int ber_encode_myDPL(unsigned char *buf, struct myDPL *myDPL) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myDPL(myDPL)); + + offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myDPL->vendor); + offset += BER_ENCODE_CTYPE_VISSTRING255(&buf[offset], &myDPL->hwRev); + + return offset; } -int ber_get_length_myPos(struct myPos *myPos) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_DBPOS(&myPos->stVal); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&myPos->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myPos->t); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_BOOLEAN(&myPos->ctlVal); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myPos(struct myPos *myPos) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_DBPOS(&myPos->stVal); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&myPos->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myPos->t); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_BOOLEAN(&myPos->ctlVal); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myPos(unsigned char *buf, struct myPos *myPos) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myPos(myPos)); - - offset += BER_ENCODE_CTYPE_DBPOS(&buf[offset], &myPos->stVal); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myPos->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myPos->t); - offset += BER_ENCODE_CTYPE_BOOLEAN(&buf[offset], &myPos->ctlVal); - - return offset; +int ber_encode_myPos(unsigned char *buf, struct myPos *myPos) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myPos(myPos)); + + offset += BER_ENCODE_CTYPE_DBPOS(&buf[offset], &myPos->stVal); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myPos->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myPos->t); + offset += BER_ENCODE_CTYPE_BOOLEAN(&buf[offset], &myPos->ctlVal); + + return offset; } -int ber_get_length_mySPS(struct mySPS *mySPS) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_INT32(&mySPS->stVal); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&mySPS->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&mySPS->t); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_mySPS(struct mySPS *mySPS) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_INT32(&mySPS->stVal); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&mySPS->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&mySPS->t); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_mySPS(unsigned char *buf, struct mySPS *mySPS) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_mySPS(mySPS)); - - offset += BER_ENCODE_CTYPE_INT32(&buf[offset], &mySPS->stVal); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &mySPS->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &mySPS->t); - - return offset; +int ber_encode_mySPS(unsigned char *buf, struct mySPS *mySPS) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_mySPS(mySPS)); + + offset += BER_ENCODE_CTYPE_INT32(&buf[offset], &mySPS->stVal); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &mySPS->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &mySPS->t); + + return offset; } -int ber_get_length_myMV(struct myMV *myMV) { - int total = 0; - int len = 0; - - len = ber_get_length_myAnalogValue(&myMV->mag); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&myMV->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myMV->t); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_ScaledValueConfig(&myMV->sVC); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myMV(struct myMV *myMV) { + int total = 0; + int len = 0; + + len = ber_get_length_myAnalogValue(&myMV->mag); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&myMV->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myMV->t); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_ScaledValueConfig(&myMV->sVC); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myMV(unsigned char *buf, struct myMV *myMV) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myMV(myMV)); - - offset += ber_encode_myAnalogValue(&buf[offset], &myMV->mag); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myMV->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myMV->t); - offset += ber_encode_ScaledValueConfig(&buf[offset], &myMV->sVC); - - return offset; +int ber_encode_myMV(unsigned char *buf, struct myMV *myMV) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myMV(myMV)); + + offset += ber_encode_myAnalogValue(&buf[offset], &myMV->mag); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myMV->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myMV->t); + offset += ber_encode_ScaledValueConfig(&buf[offset], &myMV->sVC); + + return offset; } -int ber_get_length_simpleMV(struct simpleMV *simpleMV) { - int total = 0; - int len = 0; - - len = BER_GET_LENGTH_CTYPE_FLOAT32(&simpleMV->mag); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&simpleMV->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&simpleMV->t); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_ScaledValueConfig(&simpleMV->sVC); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_simpleMV(struct simpleMV *simpleMV) { + int total = 0; + int len = 0; + + len = BER_GET_LENGTH_CTYPE_FLOAT32(&simpleMV->mag); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&simpleMV->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&simpleMV->t); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_ScaledValueConfig(&simpleMV->sVC); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_simpleMV(unsigned char *buf, struct simpleMV *simpleMV) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_simpleMV(simpleMV)); - - offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &simpleMV->mag); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &simpleMV->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &simpleMV->t); - offset += ber_encode_ScaledValueConfig(&buf[offset], &simpleMV->sVC); - - return offset; +int ber_encode_simpleMV(unsigned char *buf, struct simpleMV *simpleMV) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_simpleMV(simpleMV)); + + offset += BER_ENCODE_CTYPE_FLOAT32(&buf[offset], &simpleMV->mag); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &simpleMV->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &simpleMV->t); + offset += ber_encode_ScaledValueConfig(&buf[offset], &simpleMV->sVC); + + return offset; } -int ber_get_length_simpleCMV(struct simpleCMV *simpleCMV) { - int total = 0; - int len = 0; - - len = ber_get_length_simpleVector(&simpleCMV->cVal); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&simpleCMV->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&simpleCMV->t); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_simpleCMV(struct simpleCMV *simpleCMV) { + int total = 0; + int len = 0; + + len = ber_get_length_simpleVector(&simpleCMV->cVal); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&simpleCMV->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&simpleCMV->t); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_simpleCMV(unsigned char *buf, struct simpleCMV *simpleCMV) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_simpleCMV(simpleCMV)); - - offset += ber_encode_simpleVector(&buf[offset], &simpleCMV->cVal); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &simpleCMV->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &simpleCMV->t); - - return offset; +int ber_encode_simpleCMV(unsigned char *buf, struct simpleCMV *simpleCMV) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_simpleCMV(simpleCMV)); + + offset += ber_encode_simpleVector(&buf[offset], &simpleCMV->cVal); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &simpleCMV->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &simpleCMV->t); + + return offset; } -int ber_get_length_simpleWYE(struct simpleWYE *simpleWYE) { - int total = 0; - int len = 0; - - len = ber_get_length_simpleCMV(&simpleWYE->phsA); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_simpleCMV(&simpleWYE->phsB); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_simpleCMV(&simpleWYE->phsC); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_simpleWYE(struct simpleWYE *simpleWYE) { + int total = 0; + int len = 0; + + len = ber_get_length_simpleCMV(&simpleWYE->phsA); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_simpleCMV(&simpleWYE->phsB); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_simpleCMV(&simpleWYE->phsC); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_simpleWYE(unsigned char *buf, struct simpleWYE *simpleWYE) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_simpleWYE(simpleWYE)); - - offset += ber_encode_simpleCMV(&buf[offset], &simpleWYE->phsA); - offset += ber_encode_simpleCMV(&buf[offset], &simpleWYE->phsB); - offset += ber_encode_simpleCMV(&buf[offset], &simpleWYE->phsC); - - return offset; +int ber_encode_simpleWYE(unsigned char *buf, struct simpleWYE *simpleWYE) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_simpleWYE(simpleWYE)); + + offset += ber_encode_simpleCMV(&buf[offset], &simpleWYE->phsA); + offset += ber_encode_simpleCMV(&buf[offset], &simpleWYE->phsB); + offset += ber_encode_simpleCMV(&buf[offset], &simpleWYE->phsC); + + return offset; } -int ber_get_length_myCMV(struct myCMV *myCMV) { - int total = 0; - int len = 0; - - len = ber_get_length_myVector(&myCMV->cVal); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&myCMV->q); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myCMV->t); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_myCMV(struct myCMV *myCMV) { + int total = 0; + int len = 0; + + len = ber_get_length_myVector(&myCMV->cVal); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&myCMV->q); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_TIMESTAMP(&myCMV->t); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_myCMV(unsigned char *buf, struct myCMV *myCMV) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_myCMV(myCMV)); - - offset += ber_encode_myVector(&buf[offset], &myCMV->cVal); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myCMV->q); - offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myCMV->t); - - return offset; +int ber_encode_myCMV(unsigned char *buf, struct myCMV *myCMV) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_myCMV(myCMV)); + + offset += ber_encode_myVector(&buf[offset], &myCMV->cVal); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &myCMV->q); + offset += BER_ENCODE_CTYPE_TIMESTAMP(&buf[offset], &myCMV->t); + + return offset; } -int ber_get_length_mySEQ(struct mySEQ *mySEQ) { - int total = 0; - int len = 0; - - len = ber_get_length_myCMV(&mySEQ->c1); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myCMV(&mySEQ->c2); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myCMV(&mySEQ->c3); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &mySEQ->seqT); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_mySEQ(struct mySEQ *mySEQ) { + int total = 0; + int len = 0; + + len = ber_get_length_myCMV(&mySEQ->c1); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myCMV(&mySEQ->c2); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myCMV(&mySEQ->c3); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &mySEQ->seqT); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_mySEQ(unsigned char *buf, struct mySEQ *mySEQ) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_mySEQ(mySEQ)); - - offset += ber_encode_myCMV(&buf[offset], &mySEQ->c1); - offset += ber_encode_myCMV(&buf[offset], &mySEQ->c2); - offset += ber_encode_myCMV(&buf[offset], &mySEQ->c3); - offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &mySEQ->seqT); - - return offset; +int ber_encode_mySEQ(unsigned char *buf, struct mySEQ *mySEQ) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_mySEQ(mySEQ)); + + offset += ber_encode_myCMV(&buf[offset], &mySEQ->c1); + offset += ber_encode_myCMV(&buf[offset], &mySEQ->c2); + offset += ber_encode_myCMV(&buf[offset], &mySEQ->c3); + offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &mySEQ->seqT); + + return offset; } -int ber_get_length_mySAV(struct mySAV *mySAV) { - int total = 0; - int len = 0; - - len = ber_get_length_myAnalogValue(&mySAV->instMag); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&mySAV->q); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_mySAV(struct mySAV *mySAV) { + int total = 0; + int len = 0; + + len = ber_get_length_myAnalogValue(&mySAV->instMag); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&mySAV->q); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_mySAV(unsigned char *buf, struct mySAV *mySAV) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_mySAV(mySAV)); - - offset += ber_encode_myAnalogValue(&buf[offset], &mySAV->instMag); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &mySAV->q); - - return offset; +int ber_encode_mySAV(unsigned char *buf, struct mySAV *mySAV) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_mySAV(mySAV)); + + offset += ber_encode_myAnalogValue(&buf[offset], &mySAV->instMag); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &mySAV->q); + + return offset; } -int ber_get_length_simpleSAV(struct simpleSAV *simpleSAV) { - int total = 0; - int len = 0; - - len = ber_get_length_myAnalogValue(&simpleSAV->instMag); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_QUALITY(&simpleSAV->q); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_simpleSAV(struct simpleSAV *simpleSAV) { + int total = 0; + int len = 0; + + len = ber_get_length_myAnalogValue(&simpleSAV->instMag); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_QUALITY(&simpleSAV->q); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_simpleSAV(unsigned char *buf, struct simpleSAV *simpleSAV) { - int offset = 0; - - buf[offset++] = 0xA2; - offset += encodeLength(&buf[offset], ber_get_length_simpleSAV(simpleSAV)); - - offset += ber_encode_myAnalogValue(&buf[offset], &simpleSAV->instMag); - offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &simpleSAV->q); - - return offset; +int ber_encode_simpleSAV(unsigned char *buf, struct simpleSAV *simpleSAV) { + int offset = 0; + + buf[offset++] = 0xA2; + offset += encodeLength(&buf[offset], ber_get_length_simpleSAV(simpleSAV)); + + offset += ber_encode_myAnalogValue(&buf[offset], &simpleSAV->instMag); + offset += BER_ENCODE_CTYPE_QUALITY(&buf[offset], &simpleSAV->q); + + return offset; } -int ber_get_length_Itl() { - int total = 0; - int len = 0; - - len = ber_get_length_myAnalogValue(&E1Q1SB1.S1.C1.TVTR_1.Vol.instMag); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myPos(&E1Q1SB1.S1.C1.CSWI_1.Pos); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myPos(&E1Q1SB1.S1.C1.CSWI_2.Pos); - total += len + getLengthBytes(len) + 1; - len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &E1Q1SB1.S1.C1.MMXU_1.Mod.stVal); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myMV(&E1Q1SB1.S1.C1.MMXU_1.Amps); - total += len + getLengthBytes(len) + 1; - len = ber_get_length_myMV(&E1Q1SB1.S1.C1.MMXU_1.Volts); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_Itl() { + int total = 0; + int len = 0; + + len = ber_get_length_myAnalogValue(&E1Q1SB1.S1.C1.TVTR_1.Vol.instMag); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myPos(&E1Q1SB1.S1.C1.CSWI_1.Pos); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myPos(&E1Q1SB1.S1.C1.CSWI_2.Pos); + total += len + getLengthBytes(len) + 1; + len = BER_GET_LENGTH_CTYPE_ENUM((CTYPE_ENUM *) &E1Q1SB1.S1.C1.MMXU_1.Mod.stVal); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myMV(&E1Q1SB1.S1.C1.MMXU_1.Amps); + total += len + getLengthBytes(len) + 1; + len = ber_get_length_myMV(&E1Q1SB1.S1.C1.MMXU_1.Volts); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_Itl(unsigned char *buf) { - int offset = 0; - - offset += ber_encode_myAnalogValue(&buf[offset], &E1Q1SB1.S1.C1.TVTR_1.Vol.instMag); - offset += ber_encode_myPos(&buf[offset], &E1Q1SB1.S1.C1.CSWI_1.Pos); - offset += ber_encode_myPos(&buf[offset], &E1Q1SB1.S1.C1.CSWI_2.Pos); - offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &E1Q1SB1.S1.C1.MMXU_1.Mod.stVal); - offset += ber_encode_myMV(&buf[offset], &E1Q1SB1.S1.C1.MMXU_1.Amps); - offset += ber_encode_myMV(&buf[offset], &E1Q1SB1.S1.C1.MMXU_1.Volts); - - return offset; +int ber_encode_Itl(unsigned char *buf) { + int offset = 0; + + offset += ber_encode_myAnalogValue(&buf[offset], &E1Q1SB1.S1.C1.TVTR_1.Vol.instMag); + offset += ber_encode_myPos(&buf[offset], &E1Q1SB1.S1.C1.CSWI_1.Pos); + offset += ber_encode_myPos(&buf[offset], &E1Q1SB1.S1.C1.CSWI_2.Pos); + offset += BER_ENCODE_CTYPE_ENUM(&buf[offset], (CTYPE_ENUM *) &E1Q1SB1.S1.C1.MMXU_1.Mod.stVal); + offset += ber_encode_myMV(&buf[offset], &E1Q1SB1.S1.C1.MMXU_1.Amps); + offset += ber_encode_myMV(&buf[offset], &E1Q1SB1.S1.C1.MMXU_1.Volts); + + return offset; } -int ber_get_length_SynChk() { - int total = 0; - int len = 0; - - len = ber_get_length_mySPS(&D1Q1SB4.S1.C1.RSYN_1.Rel); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_SynChk() { + int total = 0; + int len = 0; + + len = ber_get_length_mySPS(&D1Q1SB4.S1.C1.RSYN_1.Rel); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_SynChk(unsigned char *buf) { - int offset = 0; - - offset += ber_encode_mySPS(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.Rel); - - return offset; +int ber_encode_SynChk(unsigned char *buf) { + int offset = 0; + + offset += ber_encode_mySPS(&buf[offset], &D1Q1SB4.S1.C1.RSYN_1.Rel); + + return offset; } -int ber_get_length_MMXUResult() { - int total = 0; - int len = 0; - - len = ber_get_length_simpleWYE(&D1Q1SB4.S1.C1.MMXU_1.A); - total += len + getLengthBytes(len) + 1; - - return total; +int ber_get_length_MMXUResult() { + int total = 0; + int len = 0; + + len = ber_get_length_simpleWYE(&D1Q1SB4.S1.C1.MMXU_1.A); + total += len + getLengthBytes(len) + 1; + + return total; } -int ber_encode_MMXUResult(unsigned char *buf) { - int offset = 0; - - offset += ber_encode_simpleWYE(&buf[offset], &D1Q1SB4.S1.C1.MMXU_1.A); - - return offset; +int ber_encode_MMXUResult(unsigned char *buf) { + int offset = 0; + + offset += ber_encode_simpleWYE(&buf[offset], &D1Q1SB4.S1.C1.MMXU_1.A); + + return offset; }