- removed old sv code
Michael Zillgith
10 years ago
parent
6e260b88a4
commit
61714b5907
@ -1,28 +0,0 @@
|
||||
IEC61850 DEFINITIONS ::= BEGIN
|
||||
IMPORTS Data FROM ISO-IEC-9506-2
|
||||
IEC 61850-9-2 Specific Protocol ::= CHOICE {
|
||||
savPdu [APPLICATION 0] IMPLICIT SavPdu,
|
||||
}
|
||||
|
||||
|
||||
SavPdu ::= SEQUENCE {
|
||||
noASDU [0] IMPLICIT INTEGER(1..65535),
|
||||
security [1] ANY OPTIONAL,
|
||||
asdu [2] IMPLICIT SEQUENCE OF ASDU
|
||||
}
|
||||
|
||||
ASDU ::= SEQUENCE {
|
||||
svID [0] IMPLICIT VisibleString,
|
||||
datset [1] IMPLICIT VisibleString OPTIONAL,
|
||||
smpCnt [2] IMPLICIT OCTET STRING (SIZE(2)),
|
||||
confRev [3] IMPLICIT OCTET STRING (SIZE(4)),
|
||||
refrTm [4] IMPLICIT UtcTime OPTIONAL,
|
||||
smpSynch [5] IMPLICIT OCTET STRING (SIZE(1)),
|
||||
smpRate [6] IMPLICIT OCTET STRING (SIZE(2)) OPTIONAL,
|
||||
sample [7] IMPLICIT OCTET STRING (SIZE(n)),
|
||||
smpMod [8] IMPLICIT OCTET STRING (SIZE(2)) OPTIONAL
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
@ -1,348 +0,0 @@
|
||||
/*
|
||||
* sv_publisher.c
|
||||
*
|
||||
* Copyright 2013 Michael Zillgith
|
||||
*
|
||||
* This file is part of libIEC61850.
|
||||
*
|
||||
* libIEC61850 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 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* libIEC61850 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 libIEC61850. If not, see <http://www.gnu.org/licenses/>.
|
||||
*
|
||||
* See COPYING file for the complete license text.
|
||||
*/
|
||||
|
||||
#include "stack_config.h"
|
||||
#include "libiec61850_platform_includes.h"
|
||||
|
||||
#define CONFIG_SV_DEFAULT_DST_ADDRESS CONFIG_GOOSE_DEFAULT_DST_ADDRESS
|
||||
|
||||
#define CONFIG_SV_DEFAULT_PRIORITY 4
|
||||
#define CONFIG_SV_DEFAULT_VLAN_ID 0
|
||||
#define CONFIG_SV_DEFAULT_APPID 0x4000
|
||||
|
||||
#define SV_MAX_MESSAGE_SIZE 1518
|
||||
|
||||
typedef struct sSampledValuesPublisher* SampledValuesPublisher;
|
||||
|
||||
struct sSampledValuesPublisher {
|
||||
uint8_t* buffer;
|
||||
uint16_t appId;
|
||||
EthernetSocket ethernetSocket;
|
||||
int lengthField; /* can probably be removed since packets have fixed size! */
|
||||
int payloadStart;
|
||||
|
||||
char* id;
|
||||
char* dataSetRef; /* date set reference */
|
||||
|
||||
uint16_t smpCount; /* sample counter - reset by sync */
|
||||
uint32_t confRev; /* Configuration revision according to CB */
|
||||
uint8_t smpSynch; /* Synchronization status */
|
||||
uint16_t smpRate;
|
||||
|
||||
uint64_t refreshTime; /* local buffer refresh time */
|
||||
MmsValue* refTime;
|
||||
|
||||
bool hasDataSetName; /* optional fields in sv asdu */
|
||||
bool hasRefreshTime;
|
||||
bool hasSampleRate;
|
||||
};
|
||||
|
||||
|
||||
static void
|
||||
preparePacketBuffer(SampledValuesPublisher self, CommParameters* parameters, char* interfaceID)
|
||||
{
|
||||
//TODO can GOOSE code be reused?
|
||||
|
||||
uint8_t srcAddr[6];
|
||||
|
||||
if (interfaceID != NULL)
|
||||
Ethernet_getInterfaceMACAddress(interfaceID, srcAddr);
|
||||
else
|
||||
Ethernet_getInterfaceMACAddress(CONFIG_ETHERNET_INTERFACE_ID, srcAddr);
|
||||
|
||||
uint8_t defaultDstAddr[] = CONFIG_SV_DEFAULT_DST_ADDRESS;
|
||||
|
||||
uint8_t* dstAddr;
|
||||
uint8_t priority;
|
||||
uint16_t vlanId;
|
||||
uint16_t appId;
|
||||
|
||||
if (parameters == NULL) {
|
||||
dstAddr = defaultDstAddr;
|
||||
priority = CONFIG_SV_DEFAULT_PRIORITY;
|
||||
vlanId = CONFIG_SV_DEFAULT_VLAN_ID;
|
||||
appId = CONFIG_SV_DEFAULT_APPID;
|
||||
}
|
||||
else {
|
||||
dstAddr = parameters->dstAddress;
|
||||
priority = parameters->vlanPriority;
|
||||
vlanId = parameters->vlanId;
|
||||
appId = parameters->appId;
|
||||
}
|
||||
|
||||
if (interfaceID != NULL)
|
||||
self->ethernetSocket = Ethernet_createSocket(interfaceID, dstAddr);
|
||||
else
|
||||
self->ethernetSocket = Ethernet_createSocket(CONFIG_ETHERNET_INTERFACE_ID, dstAddr);
|
||||
|
||||
self->buffer = (uint8_t*) GLOBAL_MALLOC(SV_MAX_MESSAGE_SIZE);
|
||||
|
||||
memcpy(self->buffer, dstAddr, 6);
|
||||
memcpy(self->buffer + 6, srcAddr, 6);
|
||||
|
||||
int bufPos = 12;
|
||||
|
||||
/* Priority tag - IEEE 802.1Q */
|
||||
self->buffer[bufPos++] = 0x81;
|
||||
self->buffer[bufPos++] = 0x00;
|
||||
|
||||
uint8_t tci1 = priority << 5;
|
||||
tci1 += vlanId / 256;
|
||||
|
||||
uint8_t tci2 = vlanId % 256;
|
||||
|
||||
self->buffer[bufPos++] = tci1; /* Priority + VLAN-ID */
|
||||
self->buffer[bufPos++] = tci2; /* VLAN-ID */
|
||||
|
||||
/* EtherType Sampled Values */
|
||||
self->buffer[bufPos++] = 0x88;
|
||||
self->buffer[bufPos++] = 0xBa;
|
||||
|
||||
/* APPID */
|
||||
self->buffer[bufPos++] = appId / 256;
|
||||
self->buffer[bufPos++] = appId % 256;
|
||||
|
||||
self->lengthField = bufPos;
|
||||
|
||||
/* Length */
|
||||
self->buffer[bufPos++] = 0x00;
|
||||
self->buffer[bufPos++] = 0x08;
|
||||
|
||||
/* Reserved1 */
|
||||
self->buffer[bufPos++] = 0x00;
|
||||
self->buffer[bufPos++] = 0x00;
|
||||
|
||||
/* Reserved2 */
|
||||
self->buffer[bufPos++] = 0x00;
|
||||
self->buffer[bufPos++] = 0x00;
|
||||
|
||||
self->payloadStart = bufPos;
|
||||
}
|
||||
|
||||
|
||||
static int
|
||||
encodeUInt16WithTLFixedSize(uint8_t tag, uint16_t value, uint8_t* buffer, int bufPos)
|
||||
{
|
||||
uint8_t* valueArray = (uint8_t*) &value;
|
||||
|
||||
buffer[bufPos++] = tag;
|
||||
buffer[bufPos++] = 2;
|
||||
|
||||
#if (ORDER_LITTLE_ENDIAN == 1)
|
||||
buffer[bufPos++] = valueArray[1];
|
||||
buffer[bufPos++] = valueArray[0];
|
||||
#else
|
||||
buffer[bufPos++] = valueArray[0];
|
||||
buffer[bufPos++] = valueArray[1];
|
||||
#endif
|
||||
|
||||
return bufPos;
|
||||
}
|
||||
|
||||
static int
|
||||
encodeUInt32WithTLFixedSize(uint8_t tag, uint32_t value, uint8_t* buffer, int bufPos)
|
||||
{
|
||||
uint8_t* valueArray = (uint8_t*) &value;
|
||||
|
||||
buffer[bufPos++] = tag;
|
||||
buffer[bufPos++] = 2;
|
||||
|
||||
#if (ORDER_LITTLE_ENDIAN == 1)
|
||||
buffer[bufPos++] = valueArray[3];
|
||||
buffer[bufPos++] = valueArray[2];
|
||||
buffer[bufPos++] = valueArray[1];
|
||||
buffer[bufPos++] = valueArray[0];
|
||||
#else
|
||||
buffer[bufPos++] = valueArray[0];
|
||||
buffer[bufPos++] = valueArray[1];
|
||||
buffer[bufPos++] = valueArray[2];
|
||||
buffer[bufPos++] = valueArray[3];
|
||||
#endif
|
||||
|
||||
return bufPos;
|
||||
}
|
||||
|
||||
static int
|
||||
determineEncodedMmsValueSize(MmsValue* value)
|
||||
{
|
||||
switch (MmsValue_getType(value)) {
|
||||
case MMS_ARRAY:
|
||||
case MMS_STRUCTURE: {
|
||||
int compCount = value->value.structure.size;
|
||||
int i;
|
||||
int encodedSize = 0;
|
||||
|
||||
for (i = 0; i < compCount; i++) {
|
||||
encodedSize += determineEncodedMmsValueSize(value->value.structure.components[i]);
|
||||
}
|
||||
|
||||
return encodedSize;
|
||||
}
|
||||
case MMS_INTEGER:
|
||||
return value->value.integer->maxSize;
|
||||
break;
|
||||
case MMS_UNSIGNED:
|
||||
return value->value.unsignedInteger->maxSize;
|
||||
case MMS_FLOAT:
|
||||
return value->value.floatingPoint.formatWidth / 8;
|
||||
case MMS_BIT_STRING:
|
||||
return 4;
|
||||
case MMS_UTC_TIME:
|
||||
return 8;
|
||||
case MMS_BINARY_TIME:
|
||||
return 6;
|
||||
case MMS_BOOLEAN:
|
||||
return 1;
|
||||
default:
|
||||
printf("Data type not supported for sampled values service!\n");
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static int
|
||||
encodeMmsValue(MmsValue* value, uint8_t* buffer, int bufPos)
|
||||
{
|
||||
switch (MmsValue_getType(value)) {
|
||||
case MMS_ARRAY:
|
||||
case MMS_STRUCTURE: {
|
||||
int compCount = value->value.structure.size;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < compCount; i++) {
|
||||
bufPos = encodeMmsValue(value->value.structure.components[i], buffer, bufPos);
|
||||
}
|
||||
|
||||
return bufPos;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static int
|
||||
createSVPayload(SampledValuesPublisher self, LinkedList dataSetValues, uint8_t* buffer, int maxPayloadSize) {
|
||||
|
||||
/* Step 1 - calculate length fields */
|
||||
uint32_t asduLength = 0;
|
||||
|
||||
asduLength += BerEncoder_determineEncodedStringSize(self->id);
|
||||
|
||||
if (self->hasDataSetName)
|
||||
asduLength += BerEncoder_determineEncodedStringSize(self->dataSetRef);
|
||||
|
||||
asduLength += 4 + 6 + 3 + 4; /* for smpCnt + confRev + smpSynch + smpMod */
|
||||
|
||||
if (self->hasRefreshTime)
|
||||
asduLength += 10; /* for refrTim */
|
||||
|
||||
if (self->hasSampleRate)
|
||||
asduLength += 4; /* for smpRate */
|
||||
|
||||
uint32_t numberOfDataSetEntries = LinkedList_size(dataSetValues);
|
||||
|
||||
asduLength += 2 + BerEncoder_UInt32determineEncodedSize(numberOfDataSetEntries);
|
||||
|
||||
uint32_t dataSetSize = 0;
|
||||
|
||||
LinkedList element = LinkedList_getNext(dataSetValues);
|
||||
|
||||
while (element != NULL) {
|
||||
MmsValue* dataSetEntry = (MmsValue*) element->data;
|
||||
|
||||
dataSetSize += determineEncodedMmsValueSize(dataSetEntry);
|
||||
|
||||
element = LinkedList_getNext(element);
|
||||
}
|
||||
|
||||
uint32_t allDataSize = dataSetSize + BerEncoder_determineLengthSize(dataSetSize) + 1;
|
||||
|
||||
asduLength += allDataSize;
|
||||
|
||||
uint32_t sequenceOfAsduLength = 1 + BerEncoder_DetermineLengthSize(asduLength) + asduLength;
|
||||
|
||||
uint32_t apduLength = 1 + BerEncoder_DetermineLengthSize(sequenceOfAsduLength) + sequenceOfAsduLength;
|
||||
|
||||
//TODO add length of ASDU header
|
||||
|
||||
if (apduLength > maxPayloadSize)
|
||||
return -1;
|
||||
|
||||
/* Step 2 - encode to buffer */
|
||||
|
||||
int bufPos = 0;
|
||||
|
||||
/* Encode SV PDU */
|
||||
bufPos = BerEncoder_encodeTL(0x60, apduLength, buffer, bufPos);
|
||||
|
||||
/* Encode No. of ASDUs */
|
||||
bufPos = encodeUInt16WithTLFixedSize(0x80, 1, buffer, bufPos);
|
||||
//bufPos = BerEncoder_encodeUInt32WithTL(0x80, 1, buffer, bufPos);
|
||||
|
||||
/* Encode Sequence of ASDUs */
|
||||
bufPos = BerEncoder_encodeTL(0xa2, sequenceOfAsduLength, buffer, bufPos);
|
||||
|
||||
/* Encode ASDU */
|
||||
bufPos = BerEncoder_encodeTL(0x30, asduLength, buffer, bufPos);
|
||||
|
||||
/* Encode svID */
|
||||
bufPos = BerEncoder_encodeStringWithTag(0x80, self->id, buffer, bufPos);
|
||||
|
||||
/* Encode dataSetRef */
|
||||
if (self->hasDataSetName)
|
||||
bufPos = BerEncoder_encodeStringWithTag(0x81, self->dataSetRef, buffer, bufPos);
|
||||
|
||||
/* Encode smpCnt */
|
||||
bufPos = encodeUInt16WithTLFixedSize(0x82, self->smpCount, buffer, bufPos);
|
||||
|
||||
/* Encode confRev */
|
||||
bufPos = encodeUInt32WithTLFixedSize(0x83, self->confRev, buffer, bufPos);
|
||||
|
||||
/* Encode refreshTime */
|
||||
if (self->hasRefreshTime) {
|
||||
MmsValue_setUtcTimeMs(self->refTime, self->refreshTime);
|
||||
bufPos = BerEncoder_encodeOctetString(0x84, self->refTime->value.utcTime, 8, buffer, bufPos);
|
||||
}
|
||||
|
||||
/* Encode smpSynch */
|
||||
bufPos = BerEncoder_encodeTL(0x85, dataSetSize, buffer, bufPos);
|
||||
buffer[bufPos++] = self->smpSynch;
|
||||
|
||||
/* Encode smpRate */
|
||||
if (self->hasSampleRate) {
|
||||
bufPos = encodeUInt16WithTLFixedSize(0x86, self->smpRate, buffer, bufPos);
|
||||
}
|
||||
|
||||
/* Encode sequence of data */
|
||||
bufPos = BerEncoder_encodeTL(0x87, dataSetSize, buffer, bufPos);
|
||||
|
||||
/* Encode data set entries */
|
||||
element = LinkedList_getNext(dataSetValues);
|
||||
|
||||
while (element != NULL) {
|
||||
MmsValue* dataSetEntry = (MmsValue*) element->data;
|
||||
|
||||
bufPos = mmsServer_encodeAccessResult(dataSetEntry, buffer, bufPos, true);
|
||||
|
||||
element = LinkedList_getNext(element);
|
||||
}
|
||||
|
||||
return bufPos;
|
||||
}
|
||||
Loading…
Reference in New Issue