- server side support for SV control blocks - WIP
Michael Zillgith
10 years ago
parent
25d8254683
commit
8482cfce9b
@ -0,0 +1,31 @@
|
||||
/*
|
||||
* mms_sv.h
|
||||
*
|
||||
* Copyright 2015 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.
|
||||
*/
|
||||
|
||||
#ifndef LIBIEC61850_SRC_IEC61850_INC_PRIVATE_MMS_SV_H_
|
||||
#define LIBIEC61850_SRC_IEC61850_INC_PRIVATE_MMS_SV_H_
|
||||
|
||||
MmsVariableSpecification*
|
||||
LIBIEC61850_SV_createSVControlBlocks(MmsMapping* self, MmsDomain* domain,
|
||||
LogicalNode* logicalNode, int svCount, bool unicast);
|
||||
|
||||
#endif /* LIBIEC61850_SRC_IEC61850_INC_PRIVATE_MMS_SV_H_ */
|
||||
@ -0,0 +1,251 @@
|
||||
/*
|
||||
* mms_sv.c
|
||||
*
|
||||
* Copyright 2015 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"
|
||||
|
||||
#if (CONFIG_IEC61850_SAMPLED_VALUES_SUPPORT == 1)
|
||||
|
||||
#include "libiec61850_platform_includes.h"
|
||||
#include "mms_mapping.h"
|
||||
#include "linked_list.h"
|
||||
#include "array_list.h"
|
||||
|
||||
#include "mms_mapping_internal.h"
|
||||
|
||||
|
||||
static GSEControlBlock*
|
||||
getSVCBForLogicalNodeWithIndex(MmsMapping* self, LogicalNode* logicalNode, int index, bool isUnicast)
|
||||
{
|
||||
int svCount = 0;
|
||||
|
||||
SVControlBlock* svcb = self->model->svCBs;
|
||||
|
||||
/* Iterate list of SvCBs */
|
||||
while (svcb != NULL ) {
|
||||
if ((svcb->parent == logicalNode) && (svcb->isUnicast == isUnicast)) {
|
||||
if (svCount == index)
|
||||
return svcb;
|
||||
|
||||
svCount++;
|
||||
}
|
||||
|
||||
svcb = svcb->sibling;
|
||||
}
|
||||
|
||||
return NULL ;
|
||||
}
|
||||
|
||||
|
||||
static MmsVariableSpecification*
|
||||
createSVControlBlockMmsStructure(char* gcbName, bool isUnicast)
|
||||
{
|
||||
MmsVariableSpecification* gcb = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
gcb->name = copyString(gcbName);
|
||||
gcb->type = MMS_STRUCTURE;
|
||||
|
||||
int elementCount;
|
||||
|
||||
if (isUnicast)
|
||||
elementCount = 10;
|
||||
else
|
||||
elementCount = 9;
|
||||
|
||||
gcb->typeSpec.structure.elementCount = elementCount;
|
||||
gcb->typeSpec.structure.elements = (MmsVariableSpecification**)
|
||||
GLOBAL_CALLOC(elementCount, sizeof(MmsVariableSpecification*));
|
||||
|
||||
int currentElement = 0;
|
||||
|
||||
MmsVariableSpecification* namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("SvEna");
|
||||
namedVariable->type = MMS_BOOLEAN;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
if (isUnicast) {
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("Resv");
|
||||
namedVariable->type = MMS_BOOLEAN;
|
||||
}
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
if (isUnicast)
|
||||
namedVariable->name = copyString("UsvID");
|
||||
else
|
||||
namedVariable->name = copyString("MsvID");
|
||||
namedVariable->typeSpec.visibleString = -129;
|
||||
namedVariable->type = MMS_VISIBLE_STRING;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("DatSet");
|
||||
namedVariable->typeSpec.visibleString = -129;
|
||||
namedVariable->type = MMS_VISIBLE_STRING;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("ConfRev");
|
||||
namedVariable->type = MMS_INTEGER;
|
||||
namedVariable->typeSpec.integer = 32;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("SmpRate");
|
||||
namedVariable->type = MMS_INTEGER;
|
||||
namedVariable->typeSpec.unsignedInteger = 32;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("OptFlds");
|
||||
namedVariable->type = MMS_BIT_STRING;
|
||||
namedVariable->typeSpec.bitString = 5;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("DstAddress");
|
||||
MmsMapping_createPhyComAddrStructure(namedVariable);
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1, sizeof(MmsVariableSpecification));
|
||||
namedVariable->name = copyString("noASDU");
|
||||
namedVariable->type = MMS_INTEGER;
|
||||
namedVariable->typeSpec.integer = 32;
|
||||
|
||||
gcb->typeSpec.structure.elements[currentElement++] = namedVariable;
|
||||
|
||||
return gcb;
|
||||
}
|
||||
|
||||
|
||||
|
||||
MmsVariableSpecification*
|
||||
LIBIEC61850_SV_createSVControlBlocks(MmsMapping* self, MmsDomain* domain,
|
||||
LogicalNode* logicalNode, int svCount, bool unicast)
|
||||
{
|
||||
MmsVariableSpecification* namedVariable = (MmsVariableSpecification*) GLOBAL_CALLOC(1,
|
||||
sizeof(MmsVariableSpecification));
|
||||
|
||||
if (unicast)
|
||||
namedVariable->name = copyString("US");
|
||||
else
|
||||
namedVariable->name = copyString("MS");
|
||||
|
||||
namedVariable->type = MMS_STRUCTURE;
|
||||
|
||||
namedVariable->typeSpec.structure.elementCount = svCount;
|
||||
namedVariable->typeSpec.structure.elements = (MmsVariableSpecification**) GLOBAL_CALLOC(svCount,
|
||||
sizeof(MmsVariableSpecification*));
|
||||
|
||||
int currentSVCB = 0;
|
||||
|
||||
while (currentSVCB < svCount) {
|
||||
SVControlBlock* svControlBlock = getSVCBForLogicalNodeWithIndex(
|
||||
self, logicalNode, currentSVCB, unicast);
|
||||
|
||||
MmsVariableSpecification* svTypeSpec = createSVControlBlockMmsStructure(svControlBlock->name, unicast);
|
||||
|
||||
MmsValue* svValues = MmsValue_newStructure(svTypeSpec);
|
||||
|
||||
namedVariable->typeSpec.structure.elements[currentSVCB] = svTypeSpec;
|
||||
|
||||
int currentIndex;
|
||||
|
||||
if (unicast)
|
||||
currentIndex = 2;
|
||||
else
|
||||
currentIndex = 1;
|
||||
|
||||
/* SvID */
|
||||
MmsValue* svID = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setVisibleString(svID, svControlBlock->svId);
|
||||
|
||||
/* DatSet */
|
||||
MmsValue* dataSetRef = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setVisibleString(dataSetRef, svControlBlock->dataSetName);
|
||||
|
||||
/* ConfRev */
|
||||
MmsValue* confRev = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setInt32(confRev, svControlBlock->confRev);
|
||||
|
||||
/* SmpRate */
|
||||
MmsValue* smpRate = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setInt32(smpRate, svControlBlock->smpRate);
|
||||
|
||||
/* OptFlds */
|
||||
MmsValue* optFlds = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setBitStringFromInteger(optFlds, svControlBlock->optFlds);
|
||||
|
||||
/* SmpMod */
|
||||
MmsValue* smpMod = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setInt32(smpRate, svControlBlock->smpMod);
|
||||
|
||||
/* Set communication parameters - DstAddress */
|
||||
uint8_t priority = CONFIG_GOOSE_DEFAULT_PRIORITY;
|
||||
uint8_t dstAddr[] = CONFIG_GOOSE_DEFAULT_DST_ADDRESS;
|
||||
uint16_t vid = CONFIG_GOOSE_DEFAULT_VLAN_ID;
|
||||
uint16_t appId = CONFIG_GOOSE_DEFAULT_APPID;
|
||||
|
||||
if (svControlBlock->dstAddress != NULL) {
|
||||
priority = svControlBlock->dstAddress->vlanPriority;
|
||||
vid = svControlBlock->dstAddress->vlanId;
|
||||
appId = svControlBlock->dstAddress->appId;
|
||||
|
||||
int i;
|
||||
for (i = 0; i < 6; i++) {
|
||||
dstAddr[i] = svControlBlock->dstAddress->dstAddress[i];
|
||||
}
|
||||
}
|
||||
|
||||
MmsValue* dstAddress = MmsValue_getElement(svValues, currentIndex++);
|
||||
|
||||
MmsValue* addr = MmsValue_getElement(dstAddress, 0);
|
||||
MmsValue_setOctetString(addr, dstAddr, 6);
|
||||
|
||||
MmsValue* prio = MmsValue_getElement(dstAddress, 1);
|
||||
MmsValue_setUint8(prio, priority);
|
||||
|
||||
MmsValue* vlanId = MmsValue_getElement(dstAddress, 2);
|
||||
MmsValue_setUint16(vlanId, vid);
|
||||
|
||||
MmsValue* appIdVal = MmsValue_getElement(dstAddress, 3);
|
||||
MmsValue_setUint16(appIdVal, appId);
|
||||
|
||||
/* noASDU */
|
||||
MmsValue* noASDU = MmsValue_getElement(svValues, currentIndex++);
|
||||
MmsValue_setInt32(noASDU, svControlBlock->noASDU);
|
||||
|
||||
currentSVCB++;
|
||||
}
|
||||
|
||||
return namedVariable;
|
||||
}
|
||||
|
||||
#endif /* (CONFIG_IEC61850_SAMPLED_VALUES_SUPPORT == 1) */
|
||||
@ -0,0 +1,61 @@
|
||||
package com.libiec61850.scl.communication;
|
||||
|
||||
import org.w3c.dom.Node;
|
||||
|
||||
import com.libiec61850.scl.ParserUtils;
|
||||
import com.libiec61850.scl.SclParserException;
|
||||
|
||||
/*
|
||||
* Copyright 2015 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.
|
||||
*/
|
||||
|
||||
public class SMV {
|
||||
private String ldInst;
|
||||
private String cbName;
|
||||
|
||||
private PhyComAddress address;
|
||||
|
||||
public SMV(Node gseNode) throws SclParserException {
|
||||
ldInst = ParserUtils.parseAttribute(gseNode, "ldInst");
|
||||
cbName = ParserUtils.parseAttribute(gseNode, "cbName");
|
||||
|
||||
if ((ldInst == null) || (cbName == null))
|
||||
throw new SclParserException(gseNode, "SMV is missing required attribute");
|
||||
|
||||
Node addressNode = ParserUtils.getChildNodeWithTag(gseNode, "Address");
|
||||
|
||||
if (addressNode == null)
|
||||
throw new SclParserException(gseNode, "SMV is missing address definition!");
|
||||
|
||||
address = new PhyComAddress(addressNode);
|
||||
}
|
||||
|
||||
public String getLdInst() {
|
||||
return ldInst;
|
||||
}
|
||||
|
||||
public String getCbName() {
|
||||
return cbName;
|
||||
}
|
||||
|
||||
public PhyComAddress getAddress() {
|
||||
return address;
|
||||
}
|
||||
}
|
||||
@ -0,0 +1,89 @@
|
||||
package com.libiec61850.scl.model;
|
||||
|
||||
import org.w3c.dom.Node;
|
||||
|
||||
import com.libiec61850.scl.ParserUtils;
|
||||
import com.libiec61850.scl.SclParserException;
|
||||
|
||||
public class SampledValueControl {
|
||||
|
||||
private String name;
|
||||
private String desc = null;
|
||||
private String datSet;
|
||||
private int confRev = 1;
|
||||
private String smvID;
|
||||
private int smpRate;
|
||||
private int nofASDU;
|
||||
private boolean multicast;
|
||||
private SmvOpts smvOpts;
|
||||
|
||||
|
||||
|
||||
public SampledValueControl(Node smvControlNode) throws SclParserException {
|
||||
this.name = ParserUtils.parseAttribute(smvControlNode, "name");
|
||||
this.desc = ParserUtils.parseAttribute(smvControlNode, "desc");
|
||||
this.datSet = ParserUtils.parseAttribute(smvControlNode, "datSet");
|
||||
|
||||
String confRevString = ParserUtils.parseAttribute(smvControlNode, "confRev");
|
||||
|
||||
if (confRevString != null)
|
||||
this.confRev = new Integer(confRevString);
|
||||
|
||||
this.smvID = ParserUtils.parseAttribute(smvControlNode, "smvID");
|
||||
|
||||
this.multicast = ParserUtils.parseBooleanAttribute(smvControlNode, "multicast");
|
||||
|
||||
String smpRateString = ParserUtils.parseAttribute(smvControlNode, "smpRate");
|
||||
|
||||
if (smpRateString != null)
|
||||
this.smpRate = new Integer(smpRateString);
|
||||
|
||||
String nofASDUString = ParserUtils.parseAttribute(smvControlNode, "nofASDU");
|
||||
|
||||
if (nofASDUString != null)
|
||||
this.nofASDU = new Integer(nofASDUString);
|
||||
|
||||
Node smvOptsNode = ParserUtils.getChildNodeWithTag(smvControlNode, "SmvOpts");
|
||||
|
||||
this.smvOpts = new SmvOpts(smvOptsNode);
|
||||
}
|
||||
|
||||
|
||||
|
||||
public String getName() {
|
||||
return name;
|
||||
}
|
||||
|
||||
public String getDesc() {
|
||||
return desc;
|
||||
}
|
||||
|
||||
public String getDatSet() {
|
||||
return datSet;
|
||||
}
|
||||
|
||||
public int getConfRev() {
|
||||
return confRev;
|
||||
}
|
||||
|
||||
public String getSmvID() {
|
||||
return smvID;
|
||||
}
|
||||
|
||||
public int getSmpRate() {
|
||||
return smpRate;
|
||||
}
|
||||
|
||||
public int getNofASDI() {
|
||||
return nofASDU;
|
||||
}
|
||||
|
||||
public boolean isMulticast() {
|
||||
return multicast;
|
||||
}
|
||||
|
||||
public SmvOpts getSmvOpts() {
|
||||
return smvOpts;
|
||||
}
|
||||
|
||||
}
|
||||
@ -0,0 +1,41 @@
|
||||
package com.libiec61850.scl.model;
|
||||
|
||||
import org.w3c.dom.Node;
|
||||
|
||||
import com.libiec61850.scl.ParserUtils;
|
||||
import com.libiec61850.scl.SclParserException;
|
||||
|
||||
public class SmvOpts {
|
||||
|
||||
|
||||
private boolean refreshTime = false;
|
||||
private boolean sampleRate = false;
|
||||
private boolean dataSet = false;
|
||||
private boolean security = false;
|
||||
private boolean sampleSynchronized = false;
|
||||
|
||||
public SmvOpts(Node smvOptsNode) throws SclParserException {
|
||||
|
||||
Boolean refreshTime = ParserUtils.parseBooleanAttribute(smvOptsNode, "refreshTime");
|
||||
if (refreshTime != null)
|
||||
this.refreshTime = refreshTime;
|
||||
|
||||
Boolean sampleRate = ParserUtils.parseBooleanAttribute(smvOptsNode, "sampleRate");
|
||||
if (sampleRate != null)
|
||||
this.sampleRate = sampleRate;
|
||||
|
||||
Boolean dataSet = ParserUtils.parseBooleanAttribute(smvOptsNode, "dataSet");
|
||||
if (dataSet != null)
|
||||
this.dataSet = dataSet;
|
||||
|
||||
Boolean security = ParserUtils.parseBooleanAttribute(smvOptsNode, "security");
|
||||
if (security != null)
|
||||
this.security = security;
|
||||
|
||||
Boolean sampleSynchronized = ParserUtils.parseBooleanAttribute(smvOptsNode, "sampleSynchronized");
|
||||
if (sampleSynchronized != null)
|
||||
this.sampleSynchronized = sampleSynchronized;
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
Loading…
Reference in New Issue