RYTEC
/
libiec61850
mirror of https://github.com/mz-automation/libiec61850.git
6
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

- IEC 61850 server: started to implement control service tracking

Browse Source 
(implemented support for SpcTrk)
pull/259/head
Michael Zillgith 5 years ago
parent 4ee5891388
commit 80d11fbf78
3 changed files with 349 additions and 51 deletions
Show Stats Download Patch File Download Diff File

24
src/iec61850/inc_private/mms_mapping_internal.h
Unescape Escape View File

@ -172,6 +172,29 @@ struct sUrcbTrkInstance
DataAttribute* gi; DataAttribute* gi;
}; };
typedef struct sControlTrkInstance* ControlTrkInstance;
struct sControlTrkInstance
{
/* inherited from ServiceTrkInstance */
DataObject* dobj;
DataAttribute* objRef;
DataAttribute* serviceType;
DataAttribute* errorCode;
DataAttribute* originatorID; /* optional */
DataAttribute* t;
/* CTS specific attributes */
DataAttribute* ctlVal;
DataAttribute* operTm; /* conditional */
DataAttribute* origin;
DataAttribute* ctlNum;
DataAttribute* T;
DataAttribute* Test;
DataAttribute* Check;
DataAttribute* respAddCause;
};
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */ #endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
struct sMmsMapping { struct sMmsMapping {
@ -217,6 +240,7 @@ struct sMmsMapping {
BrcbTrkInstance brcbTrk; BrcbTrkInstance brcbTrk;
UrcbTrkInstance urcbTrk; UrcbTrkInstance urcbTrk;
ControlTrkInstance spcTrk;
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */ #endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */

320
src/iec61850/server/mms_mapping/control.c
Unescape Escape View File

@ -63,6 +63,147 @@ ControlObject_sendCommandTerminationPositive(ControlObject* self);
void void
ControlObject_sendCommandTerminationNegative(ControlObject* self); ControlObject_sendCommandTerminationNegative(ControlObject* self);
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
static void
copyControlValuesToTrackingObject(MmsMapping* self, ControlObject* controlObject)
{
//TODO determine type!
if (controlObject->ctlVal) {
if (MmsValue_getType(controlObject->ctlVal) == MMS_BOOLEAN) {
if (self->spcTrk) {
if (self->spcTrk->ctlVal)
MmsValue_update(self->spcTrk->ctlVal->mmsValue, controlObject->ctlVal);
if (self->spcTrk->origin)
MmsValue_update(self->spcTrk->origin->mmsValue, controlObject->origin);
if (self->spcTrk->ctlNum)
MmsValue_update(self->spcTrk->ctlNum->mmsValue, controlObject->ctlNum);
if (self->spcTrk->operTm)
MmsValue_setUtcTimeMs(self->spcTrk->operTm->mmsValue, controlObject->operateTime);
// TODO implement remaining fields
}
}
}
}
static IEC61850_ServiceError
convertMmsDataAccessErrorToServiceError(MmsDataAccessError mmsError)
{
IEC61850_ServiceError errVal = IEC61850_SERVICE_ERROR_NO_ERROR;
switch (mmsError) {
case DATA_ACCESS_ERROR_SUCCESS:
case DATA_ACCESS_ERROR_NO_RESPONSE:
break;
case DATA_ACCESS_ERROR_TEMPORARILY_UNAVAILABLE:
errVal = IEC61850_SERVICE_ERROR_INSTANCE_LOCKED_BY_OTHER_CLIENT;
break;
case DATA_ACCESS_ERROR_OBJECT_ACCESS_DENIED:
errVal = IEC61850_SERVICE_ERROR_ACCESS_VIOLATION;
break;
case DATA_ACCESS_ERROR_TYPE_INCONSISTENT:
errVal = IEC61850_SERVICE_ERROR_PARAMETER_VALUE_INCONSISTENT;
break;
case DATA_ACCESS_ERROR_OBJECT_NONE_EXISTENT:
errVal = IEC61850_SERVICE_ERROR_INSTANCE_NOT_AVAILABLE;
break;
default:
if (DEBUG_IED_SERVER)
printf("IED_SERVER: Data access error %i not mapped!\n", mmsError);
errVal = IEC61850_SERVICE_ERROR_FAILED_DUE_TO_SERVER_CONSTRAINT;
break;
}
return errVal;
}
static IEC61850_ServiceError
convertCheckHandlerResultToServiceError(CheckHandlerResult controlHandlerResult)
{
IEC61850_ServiceError serviceError;
switch (controlHandlerResult) {
case CONTROL_HARDWARE_FAULT:
serviceError = IEC61850_SERVICE_ERROR_FAILED_DUE_TO_SERVER_CONSTRAINT;
break;
case CONTROL_TEMPORARILY_UNAVAILABLE:
serviceError = IEC61850_SERVICE_ERROR_INSTANCE_IN_USE;
break;
case CONTROL_OBJECT_ACCESS_DENIED:
serviceError = IEC61850_SERVICE_ERROR_ACCESS_VIOLATION;
break;
case CONTROL_OBJECT_UNDEFINED:
serviceError = IEC61850_SERVICE_ERROR_INSTANCE_NOT_AVAILABLE;
break;
case CONTROL_VALUE_INVALID:
serviceError = IEC61850_SERVICE_ERROR_PARAMETER_VALUE_INCONSISTENT;
break;
case CONTROL_WAITING_FOR_SELECT:
case CONTROL_ACCEPTED:
serviceError = IEC61850_SERVICE_ERROR_NO_ERROR;
break;
default:
serviceError = DATA_ACCESS_ERROR_UNKNOWN;
break;
}
return serviceError;
}
static void
updateGenericTrackingObjectValues(MmsMapping* self, ControlObject* controlObject, IEC61850_ServiceType serviceType, IEC61850_ServiceError errVal)
{
copyControlValuesToTrackingObject(self, controlObject);
ServiceTrkInstance trkInst = NULL;
if (controlObject->ctlVal) {
if (MmsValue_getType(controlObject->ctlVal) == MMS_BOOLEAN) {
// assume SPC (could also be binary controller step position or analog control!!!)
trkInst = (ServiceTrkInstance) self->spcTrk;
}
}
if (trkInst) {
if (trkInst->serviceType)
MmsValue_setInt32(trkInst->serviceType->mmsValue, (int) serviceType);
if (trkInst->t)
MmsValue_setUtcTimeMs(trkInst->t->mmsValue, Hal_getTimeInMs());
if (trkInst->errorCode)
MmsValue_setInt32(trkInst->errorCode->mmsValue, errVal);
char objRef[129];
/* create object reference */
LogicalNode* ln = (LogicalNode*) controlObject->dataObject->parent; /* TODO also handle SDO case ! */
LogicalDevice* ld = (LogicalDevice*) ln->parent;
char* iedName = self->iedServer->mmsDevice->deviceName;
snprintf(objRef, 129, "%s%s/%s", iedName, ld->name, controlObject->name);
if (trkInst->objRef) {
IedServer_updateVisibleStringAttributeValue(self->iedServer, trkInst->objRef, objRef);
}
}
}
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
static void static void
unselectObject(ControlObject* self); unselectObject(ControlObject* self);
@ -308,68 +449,86 @@ operateControl(ControlObject* self, MmsValue* value, uint64_t currentTime, bool
} }
static void static void
executeControlTask(ControlObject* self, uint64_t currentTimeInMs) executeControlTask(MmsMapping* self, ControlObject* controlObject, uint64_t currentTimeInMs)
{ {
int state; int state;
executeStateMachine: executeStateMachine:
state = getState(self); state = getState(controlObject);
switch (state) { switch (state) {
case STATE_WAIT_FOR_SELECT: case STATE_WAIT_FOR_SELECT:
{ {
self->isSelect = 1; controlObject->isSelect = 1;
CheckHandlerResult checkHandlerResult = self->checkHandler((ControlAction) self, self->checkHandlerParameter, NULL, false, false); CheckHandlerResult checkHandlerResult = controlObject->checkHandler((ControlAction) controlObject, controlObject->checkHandlerParameter, NULL, false, false);
self->isSelect = 0; controlObject->isSelect = 0;
if (checkHandlerResult != CONTROL_WAITING_FOR_SELECT) { if (checkHandlerResult != CONTROL_WAITING_FOR_SELECT) {
if (self->ctlModel == 2) { if (controlObject->ctlModel == 2) {
LinkedList values = LinkedList_create(); LinkedList values = LinkedList_create();
if (checkHandlerResult == CONTROL_ACCEPTED) { if (checkHandlerResult == CONTROL_ACCEPTED) {
LinkedList_add(values, self->sbo); LinkedList_add(values, controlObject->sbo);
selectObject(controlObject, Hal_getTimeInMs(), controlObject->mmsConnection);
selectObject(self, Hal_getTimeInMs(), self->mmsConnection); #if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_SELECT, IEC61850_SERVICE_ERROR_NO_ERROR);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
} }
else { else {
LinkedList_add(values, &emptyString); LinkedList_add(values, &emptyString);
setState(self, STATE_UNSELECTED); setState(controlObject, STATE_UNSELECTED);
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_SELECT,
convertCheckHandlerResultToServiceError(checkHandlerResult));
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
} }
MmsServerConnection_sendReadResponse(self->mmsConnection, self->operateInvokeId, values, false); MmsServerConnection_sendReadResponse(controlObject->mmsConnection, controlObject->operateInvokeId, values, false);
LinkedList_destroyStatic(values); LinkedList_destroyStatic(values);
} }
else if (self->ctlModel == 4) { else if (controlObject->ctlModel == 4) {
if (checkHandlerResult == CONTROL_ACCEPTED) { if (checkHandlerResult == CONTROL_ACCEPTED) {
selectObject(self, Hal_getTimeInMs(), self->mmsConnection); selectObject(controlObject, Hal_getTimeInMs(), controlObject->mmsConnection);
if (self->ctlNumSt) if (controlObject->ctlNumSt)
MmsValue_update(self->ctlNumSt, self->ctlNum); MmsValue_update(controlObject->ctlNumSt, controlObject->ctlNum);
if (self->originSt) if (controlObject->originSt)
MmsValue_update(self->originSt, self->origin); MmsValue_update(controlObject->originSt, controlObject->origin);
MmsServerConnection_sendWriteResponse(self->mmsConnection, self->operateInvokeId, DATA_ACCESS_ERROR_SUCCESS, false); MmsServerConnection_sendWriteResponse(controlObject->mmsConnection, controlObject->operateInvokeId, DATA_ACCESS_ERROR_SUCCESS, false);
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_SELECT_WITH_VALUES, IEC61850_SERVICE_ERROR_NO_ERROR);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)
printf("IED_SERVER: SBOw - selected successful\n"); printf("IED_SERVER: SBOw - selected successful\n");
} }
else { else {
setState(self, STATE_UNSELECTED); setState(controlObject, STATE_UNSELECTED);
ControlObject_sendLastApplError(controlObject, controlObject->mmsConnection, "SBOw", 0,
ADD_CAUSE_SELECT_FAILED, controlObject->ctlNum, controlObject->origin, false);
ControlObject_sendLastApplError(self, self->mmsConnection, "SBOw", 0, MmsServerConnection_sendWriteResponse(controlObject->mmsConnection, controlObject->operateInvokeId, (MmsDataAccessError) checkHandlerResult, false);
ADD_CAUSE_SELECT_FAILED, self->ctlNum, self->origin, false);
MmsServerConnection_sendWriteResponse(self->mmsConnection, self->operateInvokeId, (MmsDataAccessError) checkHandlerResult, false); #if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_SELECT_WITH_VALUES,
convertCheckHandlerResultToServiceError(checkHandlerResult));
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)
printf("IED_SERVER: SBOw - select rejected by application!\n"); printf("IED_SERVER: SBOw - select rejected by application!\n");
@ -377,7 +536,7 @@ executeStateMachine:
} }
else { else {
/* ERROR: invalid internal state! */ /* ERROR: invalid internal state! */
setState(self, STATE_WAIT_FOR_SELECT); setState(controlObject, STATE_WAIT_FOR_SELECT);
} }
} }
@ -395,45 +554,62 @@ executeStateMachine:
if (state == STATE_WAIT_FOR_ACTIVATION_TIME) if (state == STATE_WAIT_FOR_ACTIVATION_TIME)
isTimeActivatedControl = true; isTimeActivatedControl = true;
self->errorValue = CONTROL_ERROR_NO_ERROR; controlObject->errorValue = CONTROL_ERROR_NO_ERROR;
self->addCauseValue = ADD_CAUSE_BLOCKED_BY_SYNCHROCHECK; controlObject->addCauseValue = ADD_CAUSE_BLOCKED_BY_SYNCHROCHECK;
if (self->waitForExecutionHandler != NULL) { if (controlObject->waitForExecutionHandler != NULL) {
dynamicCheckResult = self->waitForExecutionHandler((ControlAction) self, self->waitForExecutionHandlerParameter, self->ctlVal, dynamicCheckResult = controlObject->waitForExecutionHandler((ControlAction) controlObject, controlObject->waitForExecutionHandlerParameter, controlObject->ctlVal,
self->testMode, self->synchroCheck); controlObject->testMode, controlObject->synchroCheck);
} }
if (dynamicCheckResult == CONTROL_RESULT_FAILED) { if (dynamicCheckResult == CONTROL_RESULT_FAILED) {
if ((self->errorValue != CONTROL_ERROR_NO_ERROR) || (self->addCauseValue != ADD_CAUSE_UNKNOWN)) { if ((controlObject->errorValue != CONTROL_ERROR_NO_ERROR) || (controlObject->addCauseValue != ADD_CAUSE_UNKNOWN)) {
ControlObject_sendLastApplError(self, self->mmsConnection, "Oper", ControlObject_sendLastApplError(controlObject, controlObject->mmsConnection, "Oper",
self->errorValue, self->addCauseValue, controlObject->errorValue, controlObject->addCauseValue,
self->ctlNum, self->origin, false); controlObject->ctlNum, controlObject->origin, false);
} }
if (!isTimeActivatedControl) { if (!isTimeActivatedControl) {
MmsServerConnection_sendWriteResponse(self->mmsConnection, self->operateInvokeId, MmsServerConnection_sendWriteResponse(controlObject->mmsConnection, controlObject->operateInvokeId,
DATA_ACCESS_ERROR_OBJECT_ACCESS_DENIED, true); DATA_ACCESS_ERROR_OBJECT_ACCESS_DENIED, true);
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_OPERATE, IEC61850_SERVICE_ERROR_ACCESS_NOT_ALLOWED_IN_CURRENT_STATE);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
}
else {
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_TIME_ACTIVATED_OPERATE, IEC61850_SERVICE_ERROR_ACCESS_NOT_ALLOWED_IN_CURRENT_STATE);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
} }
abortControlOperation(self); abortControlOperation(controlObject);
exitControlTask(self); exitControlTask(controlObject);
} }
else if (dynamicCheckResult == CONTROL_RESULT_OK) { else if (dynamicCheckResult == CONTROL_RESULT_OK) {
if (isTimeActivatedControl) { if (isTimeActivatedControl) {
ControlObject_sendCommandTerminationPositive(self); ControlObject_sendCommandTerminationPositive(controlObject);
MmsValue* operTm = getOperParameterOperTime(self->oper); #if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_COMMAND_TERMINATION, IEC61850_SERVICE_ERROR_NO_ERROR);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
MmsValue_setUtcTime(operTm, 0); MmsValue* operTm = getOperParameterOperTime(controlObject->oper);
MmsValue_setUtcTime(operTm, 0);
} }
else else {
MmsServerConnection_sendWriteResponse(self->mmsConnection, self->operateInvokeId, MmsServerConnection_sendWriteResponse(controlObject->mmsConnection, controlObject->operateInvokeId,
DATA_ACCESS_ERROR_SUCCESS, true); DATA_ACCESS_ERROR_SUCCESS, true);
setState(self, STATE_OPERATE); #if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_OPERATE, IEC61850_SERVICE_ERROR_NO_ERROR);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
}
setOpOk(self, true, currentTimeInMs); setState(controlObject, STATE_OPERATE);
setOpOk(controlObject, true, currentTimeInMs);
goto executeStateMachine; goto executeStateMachine;
} }
@ -444,30 +620,38 @@ executeStateMachine:
{ {
uint64_t currentTime = Hal_getTimeInMs(); uint64_t currentTime = Hal_getTimeInMs();
ControlHandlerResult result = operateControl(self, self->ctlVal, currentTime, self->testMode); ControlHandlerResult result = operateControl(controlObject, controlObject->ctlVal, currentTime, controlObject->testMode);
if (result != CONTROL_RESULT_WAITING) { if (result != CONTROL_RESULT_WAITING) {
if (result == CONTROL_RESULT_OK) { if (result == CONTROL_RESULT_OK) {
if ((self->ctlModel == 4) || (self->ctlModel == 3)) { if ((controlObject->ctlModel == 4) || (controlObject->ctlModel == 3)) {
ControlObject_sendCommandTerminationPositive(self); ControlObject_sendCommandTerminationPositive(controlObject);
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_COMMAND_TERMINATION, IEC61850_SERVICE_ERROR_NO_ERROR);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
} }
} }
else { else {
if ((self->ctlModel == 4) || (self->ctlModel == 3)) { if ((controlObject->ctlModel == 4) || (controlObject->ctlModel == 3)) {
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)
printf("IED_SERVER: operate failed!\n"); printf("IED_SERVER: operate failed!\n");
ControlObject_sendCommandTerminationNegative(self); ControlObject_sendCommandTerminationNegative(controlObject);
} }
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_COMMAND_TERMINATION, IEC61850_SERVICE_ERROR_FAILED_DUE_TO_SERVER_CONSTRAINT);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
} }
abortControlOperation(self); abortControlOperation(controlObject);
exitControlTask(self); exitControlTask(controlObject);
setOpOk(self, false, currentTimeInMs); setOpOk(controlObject, false, currentTimeInMs);
} }
} }
break; break;
@ -880,7 +1064,7 @@ Control_processControlActions(MmsMapping* self, uint64_t currentTimeInMs)
/* leave state Perform Test */ /* leave state Perform Test */
setOpRcvd(controlObject, false); setOpRcvd(controlObject, false);
executeControlTask(controlObject, currentTimeInMs); executeControlTask(self, controlObject, currentTimeInMs);
} }
else { else {
@ -888,6 +1072,8 @@ Control_processControlActions(MmsMapping* self, uint64_t currentTimeInMs)
controlObject->errorValue, controlObject->addCauseValue, controlObject->errorValue, controlObject->addCauseValue,
controlObject->ctlNum, controlObject->origin, false); controlObject->ctlNum, controlObject->origin, false);
//TODO add service tracking code (time activated control)
/* leave state Perform Test */ /* leave state Perform Test */
setOpRcvd(controlObject, false); setOpRcvd(controlObject, false);
@ -897,7 +1083,7 @@ Control_processControlActions(MmsMapping* self, uint64_t currentTimeInMs)
} /* if (controlObject->state == STATE_WAIT_FOR_ACTICATION_TIME) */ } /* if (controlObject->state == STATE_WAIT_FOR_ACTICATION_TIME) */
else if (!((controlObject->state == STATE_UNSELECTED) || (controlObject->state == STATE_READY))) { else if (!((controlObject->state == STATE_UNSELECTED) || (controlObject->state == STATE_READY))) {
executeControlTask(controlObject, currentTimeInMs); executeControlTask(self, controlObject, currentTimeInMs);
} }
else if (controlObject->state == STATE_READY) { else if (controlObject->state == STATE_READY) {
checkSelectTimeout(controlObject, currentTimeInMs); checkSelectTimeout(controlObject, currentTimeInMs);
@ -1208,6 +1394,8 @@ ControlObject_sendLastApplError(ControlObject* self, MmsServerConnection connect
MmsServerConnection_sendInformationReportSingleVariableVMDSpecific(connection, MmsServerConnection_sendInformationReportSingleVariableVMDSpecific(connection,
"LastApplError", lastApplError, handlerMode); "LastApplError", lastApplError, handlerMode);
self->addCauseValue = addCause;
} }
static void static void
@ -1351,6 +1539,10 @@ Control_readAccessControlObject(MmsMapping* self, MmsDomain* domain, char* varia
if (checkResult == CONTROL_ACCEPTED) { if (checkResult == CONTROL_ACCEPTED) {
selectObject(controlObject, currentTime, connection); selectObject(controlObject, currentTime, connection);
value = controlObject->sbo; value = controlObject->sbo;
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_SELECT, IEC61850_SERVICE_ERROR_NO_ERROR);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
} }
else if (checkResult == CONTROL_WAITING_FOR_SELECT) { else if (checkResult == CONTROL_WAITING_FOR_SELECT) {
controlObject->mmsConnection = connection; controlObject->mmsConnection = connection;
@ -1358,6 +1550,12 @@ Control_readAccessControlObject(MmsMapping* self, MmsDomain* domain, char* varia
setState(controlObject, STATE_WAIT_FOR_SELECT); setState(controlObject, STATE_WAIT_FOR_SELECT);
value = &delayedResponse; value = &delayedResponse;
} }
else {
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
updateGenericTrackingObjectValues(self, controlObject, IEC61850_SERVICE_TYPE_SELECT,
convertCheckHandlerResultToServiceError(checkResult));
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
}
} }
} }
@ -1419,10 +1617,13 @@ Control_writeAccessControlObject(MmsMapping* self, MmsDomain* domain, char* vari
MmsValue* value, MmsServerConnection connection) MmsValue* value, MmsServerConnection connection)
{ {
MmsDataAccessError indication = DATA_ACCESS_ERROR_OBJECT_ACCESS_DENIED; MmsDataAccessError indication = DATA_ACCESS_ERROR_OBJECT_ACCESS_DENIED;
IEC61850_ServiceError serviceError = IEC61850_SERVICE_ERROR_NO_ERROR;
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)
printf("IED_SERVER: writeAccessControlObject: %s\n", variableIdOrig); printf("IED_SERVER: writeAccessControlObject: %s\n", variableIdOrig);
IEC61850_ServiceType serviceType = IEC61850_SERVICE_TYPE_UNKOWN;
char variableId[65]; char variableId[65];
strncpy(variableId, variableIdOrig, 64); strncpy(variableId, variableIdOrig, 64);
@ -1497,6 +1698,8 @@ Control_writeAccessControlObject(MmsMapping* self, MmsDomain* domain, char* vari
if (strcmp(varName, "SBOw") == 0) { /* select with value */ if (strcmp(varName, "SBOw") == 0) { /* select with value */
serviceType = IEC61850_SERVICE_TYPE_SELECT_WITH_VALUES;
if (controlObject->ctlModel == 4) { if (controlObject->ctlModel == 4) {
MmsValue* ctlVal = getCtlVal(value); MmsValue* ctlVal = getCtlVal(value);
@ -1604,6 +1807,9 @@ Control_writeAccessControlObject(MmsMapping* self, MmsDomain* domain, char* vari
} }
} }
else if (strcmp(varName, "Oper") == 0) { else if (strcmp(varName, "Oper") == 0) {
serviceType = IEC61850_SERVICE_TYPE_OPERATE;
MmsValue* ctlVal = getCtlVal(value); MmsValue* ctlVal = getCtlVal(value);
MmsValue* test = getOperParameterTest(value); MmsValue* test = getOperParameterTest(value);
MmsValue* ctlNum = getOperParameterCtlNum(value); MmsValue* ctlNum = getOperParameterCtlNum(value);
@ -1783,6 +1989,8 @@ Control_writeAccessControlObject(MmsMapping* self, MmsDomain* domain, char* vari
CONTROL_ERROR_NO_ERROR, ADD_CAUSE_OBJECT_NOT_SELECTED, CONTROL_ERROR_NO_ERROR, ADD_CAUSE_OBJECT_NOT_SELECTED,
ctlNum, origin, true); ctlNum, origin, true);
serviceError = IEC61850_SERVICE_ERROR_CONTROL_MUST_BE_SELECTED;
goto free_and_return; goto free_and_return;
} }
else if ((state == STATE_OPERATE) || (state == STATE_WAIT_FOR_EXECUTION)) { else if ((state == STATE_OPERATE) || (state == STATE_WAIT_FOR_EXECUTION)) {
@ -1799,6 +2007,9 @@ Control_writeAccessControlObject(MmsMapping* self, MmsDomain* domain, char* vari
} }
} }
else if (strcmp(varName, "Cancel") == 0) { else if (strcmp(varName, "Cancel") == 0) {
serviceType = IEC61850_SERVICE_TYPE_CANCEL;
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)
printf("IED_SERVER: control received cancel!\n"); printf("IED_SERVER: control received cancel!\n");
@ -1842,6 +2053,13 @@ Control_writeAccessControlObject(MmsMapping* self, MmsDomain* domain, char* vari
free_and_return: free_and_return:
#if (CONFIG_IEC61850_SERVICE_TRACKING == 1)
if (serviceError == IEC61850_SERVICE_ERROR_NO_ERROR)
updateGenericTrackingObjectValues(self, controlObject, serviceType, convertMmsDataAccessErrorToServiceError(indication));
else
updateGenericTrackingObjectValues(self, controlObject, serviceType, serviceError);
#endif /* (CONFIG_IEC61850_SERVICE_TRACKING == 1) */
return indication; return indication;
} }

56
src/iec61850/server/mms_mapping/mms_mapping.c
Unescape Escape View File

@ -1025,6 +1025,45 @@ getUrcbTrackingAttributes(UrcbTrkInstance svcTrkInst, DataObject* trkObj)
} }
} }
static void
getControlTrackingAttributes(ControlTrkInstance svcTrkInst, DataObject* trkObj)
{
ModelNode* modelNode = trkObj->firstChild;
while (modelNode) {
if (modelNode->modelType == DataAttributeModelType) {
DataAttribute* da = (DataAttribute*) modelNode;
if (!strcmp(da->name, "ctlVal")) {
svcTrkInst->ctlVal = da;
}
else if (!strcmp(da->name, "operTm")) {
svcTrkInst->operTm = da;
}
else if (!strcmp(da->name, "origin")) {
svcTrkInst->origin = da;
}
else if (!strcmp(da->name, "ctlNum")) {
svcTrkInst->ctlNum = da;
}
else if (!strcmp(da->name, "T")) {
svcTrkInst->T = da;
}
else if (!strcmp(da->name, "Test")) {
svcTrkInst->Test = da;
}
else if (!strcmp(da->name, "Check")) {
svcTrkInst->Check = da;
}
else if (!strcmp(da->name, "respAddCause")) {
svcTrkInst->respAddCause = da;
}
}
modelNode = modelNode->sibling;
}
}
static void static void
checkForServiceTrackingVariables(MmsMapping* self, LogicalNode* logicalNode) checkForServiceTrackingVariables(MmsMapping* self, LogicalNode* logicalNode)
{ {
@ -1036,6 +1075,23 @@ checkForServiceTrackingVariables(MmsMapping* self, LogicalNode* logicalNode)
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)
printf("SpcTrk data object found!\n"); printf("SpcTrk data object found!\n");
DataObject* spcTrk = (DataObject*) modelNode;
if (self->spcTrk) {
if (DEBUG_IED_SERVER)
printf("IED_SERVER: ERROR: multiple SpcTrk instances found in server\n");
}
else {
self->spcTrk = (ControlTrkInstance) GLOBAL_CALLOC(1, sizeof(struct sControlTrkInstance));
if (self->spcTrk) {
self->spcTrk->dobj = spcTrk;
getCommonTrackingAttributes((ServiceTrkInstance) self->spcTrk, spcTrk);
getControlTrackingAttributes(self->spcTrk, spcTrk);
}
}
} }
else if (!strcmp(modelNode->name, "BrcbTrk")) { else if (!strcmp(modelNode->name, "BrcbTrk")) {
if (DEBUG_IED_SERVER) if (DEBUG_IED_SERVER)

Write Preview
Loading…
Cancel
Save