You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
305 lines
9.3 KiB
C
305 lines
9.3 KiB
C
/*
|
|
* server_example_logging.c
|
|
*
|
|
* - How to use a server with logging service
|
|
* - How to store arbitrary data in a log
|
|
*
|
|
*/
|
|
|
|
#include "iec61850_server.h"
|
|
#include "hal_thread.h"
|
|
#include <signal.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <math.h>
|
|
|
|
#include "static_model.h"
|
|
|
|
#include "logging_api.h"
|
|
|
|
static int running = 0;
|
|
static IedServer iedServer = NULL;
|
|
|
|
void
|
|
sigint_handler(int signalId)
|
|
{
|
|
running = 0;
|
|
}
|
|
|
|
static ControlHandlerResult
|
|
controlHandlerForBinaryOutput(ControlAction action, void* parameter, MmsValue* value, bool test)
|
|
{
|
|
if (test) {
|
|
printf("Received test command\n");
|
|
return CONTROL_RESULT_FAILED;
|
|
}
|
|
|
|
if (MmsValue_getType(value) == MMS_BOOLEAN) {
|
|
printf("received binary control command: ");
|
|
|
|
if (MmsValue_getBoolean(value))
|
|
printf("on\n");
|
|
else
|
|
printf("off\n");
|
|
}
|
|
else
|
|
return CONTROL_RESULT_FAILED;
|
|
|
|
uint64_t timeStamp = Hal_getTimeInMs();
|
|
|
|
if (parameter == IEDMODEL_GenericIO_GGIO1_SPCSO1) {
|
|
IedServer_updateUTCTimeAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO1_t, timeStamp);
|
|
IedServer_updateAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO1_stVal, value);
|
|
}
|
|
|
|
if (parameter == IEDMODEL_GenericIO_GGIO1_SPCSO2) {
|
|
IedServer_updateUTCTimeAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO2_t, timeStamp);
|
|
IedServer_updateAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO2_stVal, value);
|
|
}
|
|
|
|
if (parameter == IEDMODEL_GenericIO_GGIO1_SPCSO3) {
|
|
IedServer_updateUTCTimeAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO3_t, timeStamp);
|
|
IedServer_updateAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO3_stVal, value);
|
|
}
|
|
|
|
if (parameter == IEDMODEL_GenericIO_GGIO1_SPCSO4) {
|
|
IedServer_updateUTCTimeAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO4_t, timeStamp);
|
|
IedServer_updateAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO4_stVal, value);
|
|
}
|
|
|
|
return CONTROL_RESULT_OK;
|
|
}
|
|
|
|
|
|
static void
|
|
connectionHandler (IedServer self, ClientConnection connection, bool connected, void* parameter)
|
|
{
|
|
if (connected)
|
|
printf("Connection opened\n");
|
|
else
|
|
printf("Connection closed\n");
|
|
}
|
|
|
|
static bool
|
|
entryCallback(void* parameter, uint64_t timestamp, uint64_t entryID, bool moreFollow)
|
|
{
|
|
#if 0
|
|
if (moreFollow)
|
|
printf("Found entry ID:%llu timestamp:%llu\n", entryID, timestamp);
|
|
#endif
|
|
return true;
|
|
}
|
|
|
|
static bool
|
|
entryDataCallback (void* parameter, const char* dataRef, const uint8_t* data, int dataSize, uint8_t reasonCode, bool moreFollow)
|
|
{
|
|
#if 0
|
|
if (moreFollow) {
|
|
printf(" EntryData: ref: %s\n", dataRef);
|
|
|
|
MmsValue* value = MmsValue_decodeMmsData(data, 0, dataSize);
|
|
|
|
char buffer[256];
|
|
|
|
MmsValue_printToBuffer(value, buffer, 256);
|
|
|
|
printf(" value: %s\n", buffer);
|
|
|
|
MmsValue_delete(value);
|
|
}
|
|
#endif
|
|
|
|
return true;
|
|
}
|
|
|
|
static const char*
|
|
ACSIClassToStr(ACSIClass acsiClass)
|
|
{
|
|
switch (acsiClass)
|
|
{
|
|
case ACSI_CLASS_BRCB:
|
|
return "BRCB";
|
|
case ACSI_CLASS_URCB:
|
|
return "URCB";
|
|
case ACSI_CLASS_GoCB:
|
|
return "GoCB";
|
|
case ACSI_CLASS_SGCB:
|
|
return "SGCB";
|
|
case ACSI_CLASS_LCB:
|
|
return "LCB";
|
|
case ACSI_CLASS_GsCB:
|
|
return "GsCB";
|
|
case ACSI_CLASS_LOG:
|
|
return "log";
|
|
case ACSI_CLASS_DATA_SET:
|
|
return "dataset";
|
|
case ACSI_CLASS_DATA_OBJECT:
|
|
return "data-object";
|
|
case ACSI_CLASS_MSVCB:
|
|
return "MSVCB";
|
|
case ACSI_CLASS_USVCB:
|
|
return "USVCB";
|
|
default:
|
|
return "unknown";
|
|
}
|
|
}
|
|
|
|
bool
|
|
controlBlockAccessHandler(void* parameter, ClientConnection connection, ACSIClass acsiClass, LogicalDevice* ld, LogicalNode* ln, const char* objectName, const char* subObjectName, IedServer_ControlBlockAccessType accessType)
|
|
{
|
|
printf("Access to %s %s/%s.%s\n", ACSIClassToStr(acsiClass), ld->name, ln ? ln->name : "-", objectName);
|
|
|
|
if (acsiClass == ACSI_CLASS_LCB) {
|
|
if (accessType == IEC61850_CB_ACCESS_TYPE_READ)
|
|
return true;
|
|
else
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static bool
|
|
listObjectsAccessHandler(void* parameter, ClientConnection connection, ACSIClass acsiClass, LogicalDevice* ld, LogicalNode* ln, const char* objectName, const char* subObjectName, FunctionalConstraint fc)
|
|
{
|
|
if (subObjectName)
|
|
printf("list objects access[2] to %s/%s.%s.%s [acsi-class: %s(%i)] [FC=%s]\n", ld->name, ln ? ln->name : "-", objectName, subObjectName, ACSIClassToStr(acsiClass), acsiClass, FunctionalConstraint_toString(fc));
|
|
else
|
|
printf("list objects access[2] to %s/%s.%s [acsi-class: %s(%i)] [FC=%s]\n", ld->name, ln ? ln->name : "-", objectName, ACSIClassToStr(acsiClass), acsiClass, FunctionalConstraint_toString(fc));
|
|
|
|
return true;
|
|
}
|
|
|
|
int
|
|
main(int argc, char** argv)
|
|
{
|
|
int tcpPort = 102;
|
|
|
|
if (argc > 1) {
|
|
tcpPort = atoi(argv[1]);
|
|
}
|
|
|
|
printf("Using libIEC61850 version %s\n", LibIEC61850_getVersionString());
|
|
|
|
iedServer = IedServer_create(&iedModel);
|
|
|
|
/* Install handler for operate command */
|
|
IedServer_setControlHandler(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO1,
|
|
(ControlHandler) controlHandlerForBinaryOutput,
|
|
IEDMODEL_GenericIO_GGIO1_SPCSO1);
|
|
|
|
IedServer_setControlHandler(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO2,
|
|
(ControlHandler) controlHandlerForBinaryOutput,
|
|
IEDMODEL_GenericIO_GGIO1_SPCSO2);
|
|
|
|
IedServer_setControlHandler(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO3,
|
|
(ControlHandler) controlHandlerForBinaryOutput,
|
|
IEDMODEL_GenericIO_GGIO1_SPCSO3);
|
|
|
|
IedServer_setControlHandler(iedServer, IEDMODEL_GenericIO_GGIO1_SPCSO4,
|
|
(ControlHandler) controlHandlerForBinaryOutput,
|
|
IEDMODEL_GenericIO_GGIO1_SPCSO4);
|
|
|
|
IedServer_setConnectionIndicationHandler(iedServer, (IedConnectionIndicationHandler) connectionHandler, NULL);
|
|
|
|
IedServer_setControlBlockAccessHandler(iedServer, controlBlockAccessHandler, NULL);
|
|
|
|
LogStorage statusLog = SqliteLogStorage_createInstance("log_status.db");
|
|
|
|
LogStorage_setMaxLogEntries(statusLog, 10);
|
|
|
|
IedServer_setLogStorage(iedServer, "GenericIO/LLN0$EventLog", statusLog);
|
|
|
|
#if 1
|
|
uint64_t entryID = LogStorage_addEntry(statusLog, Hal_getTimeInMs());
|
|
|
|
MmsValue* value = MmsValue_newIntegerFromInt32(123);
|
|
|
|
uint8_t blob[256];
|
|
|
|
int blobSize = MmsValue_encodeMmsData(value, blob, 0, true);
|
|
|
|
|
|
LogStorage_addEntryData(statusLog, entryID, "simpleIOGenerioIO/GPIO1$ST$SPCSO1$stVal", blob, blobSize, 0);
|
|
|
|
MmsValue_delete(value);
|
|
|
|
value = MmsValue_newUtcTimeByMsTime(Hal_getTimeInMs());
|
|
|
|
blobSize = MmsValue_encodeMmsData(value, blob, 0, true);
|
|
|
|
MmsValue_delete(value);
|
|
|
|
LogStorage_addEntryData(statusLog, entryID, "simpleIOGenerioIO/GPIO1$ST$SPCSO1$t", blob, blobSize, 0);
|
|
|
|
LogStorage_getEntries(statusLog, 0, Hal_getTimeInMs(), entryCallback, (LogEntryDataCallback) entryDataCallback, NULL);
|
|
#endif
|
|
|
|
IedServer_setListObjectsAccessHandler(iedServer, listObjectsAccessHandler, NULL);
|
|
|
|
/* MMS server will be instructed to start listening to client connections. */
|
|
IedServer_start(iedServer, tcpPort);
|
|
|
|
if (!IedServer_isRunning(iedServer)) {
|
|
printf("Starting server failed! Exit.\n");
|
|
IedServer_destroy(iedServer);
|
|
exit(-1);
|
|
}
|
|
|
|
running = 1;
|
|
|
|
signal(SIGINT, sigint_handler);
|
|
|
|
float t = 0.f;
|
|
|
|
while (running) {
|
|
uint64_t timestamp = Hal_getTimeInMs();
|
|
|
|
t += 0.1f;
|
|
|
|
float an1 = sinf(t);
|
|
float an2 = sinf(t + 1.f);
|
|
float an3 = sinf(t + 2.f);
|
|
float an4 = sinf(t + 3.f);
|
|
|
|
IedServer_lockDataModel(iedServer);
|
|
|
|
Timestamp iecTimestamp;
|
|
|
|
Timestamp_clearFlags(&iecTimestamp);
|
|
Timestamp_setTimeInMilliseconds(&iecTimestamp, timestamp);
|
|
Timestamp_setLeapSecondKnown(&iecTimestamp, true);
|
|
|
|
/* toggle clock-not-synchronized flag in timestamp */
|
|
if (((int) t % 2) == 0)
|
|
Timestamp_setClockNotSynchronized(&iecTimestamp, true);
|
|
|
|
IedServer_updateTimestampAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn1_t, &iecTimestamp);
|
|
IedServer_updateFloatAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn1_mag_f, an1);
|
|
|
|
IedServer_updateTimestampAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn2_t, &iecTimestamp);
|
|
IedServer_updateFloatAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn2_mag_f, an2);
|
|
|
|
IedServer_updateTimestampAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn3_t, &iecTimestamp);
|
|
IedServer_updateFloatAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn3_mag_f, an3);
|
|
|
|
IedServer_updateTimestampAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn4_t, &iecTimestamp);
|
|
IedServer_updateFloatAttributeValue(iedServer, IEDMODEL_GenericIO_GGIO1_AnIn4_mag_f, an4);
|
|
|
|
IedServer_unlockDataModel(iedServer);
|
|
|
|
Thread_sleep(100);
|
|
}
|
|
|
|
/* stop MMS server - close TCP server socket and all client sockets */
|
|
IedServer_stop(iedServer);
|
|
|
|
/* Cleanup - free all resources */
|
|
IedServer_destroy(iedServer);
|
|
|
|
/* Release connection to database and free resources */
|
|
LogStorage_destroy(statusLog);
|
|
return 0;
|
|
|
|
} /* main() */
|