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

- code format updates

Browse Source
v1.6_develop_471
Michael Zillgith 10 months ago
parent dc199b2d8a
commit 4724658ade
2 changed files with 91 additions and 36 deletions
Show Stats Download Patch File Download Diff File

2
src/mms/iso_cotp/cotp.c
Unescape Escape View File

@ -5,7 +5,7 @@
* *
* Partial implementation of the ISO 8073 COTP (ISO TP0) protocol for MMS. * Partial implementation of the ISO 8073 COTP (ISO TP0) protocol for MMS.
* *
* Copyright 2013-2023 Michael Zillgith * Copyright 2013-2024 Michael Zillgith
* *
* This file is part of libIEC61850. * This file is part of libIEC61850.
* *

125
src/mms/iso_session/iso_session.c
Unescape Escape View File

@ -1,7 +1,7 @@
/* /*
* iso_session.c * iso_session.c
* *
* Copyright 2013 Michael Zillgith * Copyright 2013-2024 Michael Zillgith
* *
* This file is part of libIEC61850. * This file is part of libIEC61850.
* *
@ -21,10 +21,10 @@
* See COPYING file for the complete license text. * See COPYING file for the complete license text.
*/ */
#include "libiec61850_platform_includes.h"
#include "stack_config.h"
#include "iso_session.h" #include "iso_session.h"
#include "buffer_chain.h" #include "buffer_chain.h"
#include "libiec61850_platform_includes.h"
#include "stack_config.h"
#if ((DEBUG_ISO_SERVER == 1) || (DEBUG_ISO_CLIENT == 1)) #if ((DEBUG_ISO_SERVER == 1) || (DEBUG_ISO_CLIENT == 1))
#define DEBUG_SESSION 1 #define DEBUG_SESSION 1
@ -43,11 +43,13 @@ parseAcceptParameters(IsoSession* session, ByteBuffer* message, int startOffset,
int offset = startOffset; int offset = startOffset;
int maxOffset = offset + parameterLength; int maxOffset = offset + parameterLength;
while (offset < maxOffset) { while (offset < maxOffset)
{
pi = message->buffer[offset++]; pi = message->buffer[offset++];
param_len = message->buffer[offset++]; param_len = message->buffer[offset++];
switch (pi) { switch (pi)
{
case 19: /* Protocol options */ case 19: /* Protocol options */
if (param_len != 1) if (param_len != 1)
return -1; return -1;
@ -64,9 +66,16 @@ parseAcceptParameters(IsoSession* session, ByteBuffer* message, int startOffset,
case 22: /* Version Number */ case 22: /* Version Number */
param_val = message->buffer[offset++]; param_val = message->buffer[offset++];
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: Param - Version number\n"); printf("SESSION: Param - Version number %i\n", param_val);
if (param_val != 2) if (param_val != 2)
{
if (DEBUG_SESSION)
printf("SESSION: invalid version number\n");
return -1; return -1;
}
hasProtocolVersion = 1; hasProtocolVersion = 1;
break; break;
case 23: /* Initial Serial Number */ case 23: /* Initial Serial Number */
@ -119,17 +128,20 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
uint8_t pgi; uint8_t pgi;
uint8_t parameterLength; uint8_t parameterLength;
while (offset < (parametersOctets + 2)) { while (offset < (parametersOctets + 2))
{
pgi = message->buffer[offset++]; pgi = message->buffer[offset++];
parameterLength = message->buffer[offset++]; parameterLength = message->buffer[offset++];
switch (pgi) { switch (pgi)
{
case 1: /* Connection Identifier */ case 1: /* Connection Identifier */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: PGI - connection identifier\n"); printf("SESSION: PGI - connection identifier\n");
offset += parameterLength; offset += parameterLength;
break; break;
case 5: /* Connection/Accept Item */ case 5: /* Connection/Accept Item */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: PGI - Connection/Accept Item\n"); printf("SESSION: PGI - Connection/Accept Item\n");
@ -143,9 +155,11 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
offset += connectAcceptLen; offset += connectAcceptLen;
break; break;
case 17: /* Transport disconnect */ case 17: /* Transport disconnect */
offset += parameterLength; offset += parameterLength;
break; break;
case 20: /* Session User Requirements */ case 20: /* Session User Requirements */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: Parameter - Session User Req\n"); printf("SESSION: Parameter - Session User Req\n");
@ -155,12 +169,15 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
session->sessionRequirement = message->buffer[offset++] * 0x100; session->sessionRequirement = message->buffer[offset++] * 0x100;
session->sessionRequirement += message->buffer[offset++]; session->sessionRequirement += message->buffer[offset++];
break; break;
case 25: /* Enclosure item */ case 25: /* Enclosure item */
offset += parameterLength; offset += parameterLength;
break; break;
case 49: case 49:
offset += parameterLength; offset += parameterLength;
break; break;
case 51: /* Calling Session Selector */ case 51: /* Calling Session Selector */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: Parameter - Calling Session Selector\n"); printf("SESSION: Parameter - Calling Session Selector\n");
@ -177,6 +194,7 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
} }
break; break;
case 52: /* Called Session Selector */ case 52: /* Called Session Selector */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: Parameter - Called Session Selector\n"); printf("SESSION: Parameter - Called Session Selector\n");
@ -185,26 +203,28 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
return SESSION_ERROR; return SESSION_ERROR;
{ {
session->calledSessionSelector.size = parameterLength; session->calledSessionSelector.size = parameterLength;
int i; int i;
for (i = 0; i < session->calledSessionSelector.size; i++) for (i = 0; i < session->calledSessionSelector.size; i++)
session->calledSessionSelector.value[i] = message->buffer[offset++]; session->calledSessionSelector.value[i] = message->buffer[offset++];
} }
break; break;
case 60: /* Data Overflow */ case 60: /* Data Overflow */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: Parameter - Data Overflow\n"); printf("SESSION: Parameter - Data Overflow\n");
offset += parameterLength; offset += parameterLength;
break; break;
case 193: /* User Data */ case 193: /* User Data */
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: PGI - user data\n"); printf("SESSION: PGI - user data\n");
/* here we should return - the remaining data is for upper layers ! */ /* here we should return - the remaining data is for upper layers ! */
ByteBuffer_wrap(&session->userData, message->buffer + offset, ByteBuffer_wrap(&session->userData, message->buffer + offset, message->size - offset,
message->size - offset, message->maxSize - offset); message->maxSize - offset);
return SESSION_OK; return SESSION_OK;
@ -212,6 +232,7 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: PGI - extended user data\n"); printf("SESSION: PGI - extended user data\n");
break; break;
default: default:
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: invalid parameter/PGI\n"); printf("SESSION: invalid parameter/PGI\n");
@ -222,14 +243,14 @@ parseSessionHeaderParameters(IsoSession* session, ByteBuffer* message, int param
return SESSION_ERROR; return SESSION_ERROR;
} }
static const uint8_t dataSpdu[] = { 0x01, 0x00, 0x01, 0x00 }; static const uint8_t dataSpdu[] = {0x01, 0x00, 0x01, 0x00};
void void
IsoSession_createDataSpdu(IsoSession* self, BufferChain buffer, BufferChain payload) IsoSession_createDataSpdu(IsoSession* self, BufferChain buffer, BufferChain payload)
{ {
(void)self; (void)self;
buffer->buffer = (uint8_t*) dataSpdu; buffer->buffer = (uint8_t*)dataSpdu;
buffer->partLength = 4; buffer->partLength = 4;
buffer->length = 4 + payload->length; buffer->length = 4 + payload->length;
buffer->nextPart = payload; buffer->nextPart = payload;
@ -250,13 +271,28 @@ encodeConnectAcceptItem(uint8_t* buf, int offset, uint8_t options)
return offset; return offset;
} }
static int
encodeConnectionIdentifier(uint8_t* buf, int offset, uint8_t reasonCode)
{
buf[offset++] = 1; /* Connection Identifier */
buf[offset++] = 2; /* LEN */
buf[offset++] = 17; /* Transport Disconnect */
buf[offset++] = 1; /* L=1 */
buf[offset++] = 1; /* VALUE = release transport connection */
buf[offset++] = 50; /* Reason code */
buf[offset++] = 1; /* L=1 */
buf[offset++] = reasonCode;
return offset;
}
static int static int
encodeSessionRequirement(IsoSession* self, uint8_t* buf, int offset) encodeSessionRequirement(IsoSession* self, uint8_t* buf, int offset)
{ {
buf[offset++] = 0x14; buf[offset++] = 0x14;
buf[offset++] = 2; buf[offset++] = 2;
buf[offset++] = (uint8_t) (self->sessionRequirement / 0x100); buf[offset++] = (uint8_t)(self->sessionRequirement / 0x100);
buf[offset++] = (uint8_t) (self->sessionRequirement & 0x00ff); buf[offset++] = (uint8_t)(self->sessionRequirement & 0x00ff);
return offset; return offset;
} }
@ -297,7 +333,8 @@ encodeSessionUserData(uint8_t* buf, int offset, uint8_t payloadLength)
} }
void void
IsoSession_createConnectSpdu(IsoSession* self, IsoConnectionParameters isoParameters, BufferChain buffer, BufferChain payload) IsoSession_createConnectSpdu(IsoSession* self, IsoConnectionParameters isoParameters, BufferChain buffer,
BufferChain payload)
{ {
int offset = 0; int offset = 0;
uint8_t* buf = buffer->buffer; uint8_t* buf = buffer->buffer;
@ -337,13 +374,13 @@ IsoSession_createAbortSpdu(IsoSession* self, BufferChain buffer, BufferChain pay
int offset = 0; int offset = 0;
uint8_t* buf = buffer->buffer; uint8_t* buf = buffer->buffer;
buf[offset++] = 25; /* ABORT-SPDU code */ buf[offset++] = 25; /* ABORT-SPDU code */
buf[offset++] = 5 + payload->length; /* LI */ buf[offset++] = 5 + payload->length; /* LI */
buf[offset++] = 17; /* PI-Code transport-disconnect */ buf[offset++] = 17; /* PI-Code transport-disconnect */
buf[offset++] = 1; /* LI = 1 */ buf[offset++] = 1; /* LI = 1 */
buf[offset++] = 11; /* transport-connection-released | user-abort | no-reason */ buf[offset++] = 11; /* transport-connection-released | user-abort | no-reason */
buf[offset++] = 193; /* PGI-Code user data */ buf[offset++] = 193; /* PGI-Code user data */
buf[offset++] = payload->length; /* LI of user data */ buf[offset++] = payload->length; /* LI of user data */
buffer->partLength = offset; buffer->partLength = offset;
buffer->length = payload->length + offset; buffer->length = payload->length + offset;
@ -361,8 +398,8 @@ IsoSession_createFinishSpdu(IsoSession* self, BufferChain buffer, BufferChain pa
buf[offset++] = 9; /* FINISH-SPDU code */ buf[offset++] = 9; /* FINISH-SPDU code */
buf[offset++] = 2 + payload->length; /* LI */ buf[offset++] = 2 + payload->length; /* LI */
buf[offset++] = 193; /* PGI-Code user data */ buf[offset++] = 193; /* PGI-Code user data */
buf[offset++] = payload->length; /* LI of user data */ buf[offset++] = payload->length; /* LI of user data */
buffer->partLength = offset; buffer->partLength = offset;
buffer->length = payload->length + offset; buffer->length = payload->length + offset;
@ -380,8 +417,8 @@ IsoSession_createDisconnectSpdu(IsoSession* self, BufferChain buffer, BufferChai
buf[offset++] = 10; /* DISCONNECT-SPDU code */ buf[offset++] = 10; /* DISCONNECT-SPDU code */
buf[offset++] = 2 + payload->length; /* LI */ buf[offset++] = 2 + payload->length; /* LI */
buf[offset++] = 193; /* PGI-Code user data */ buf[offset++] = 193; /* PGI-Code user data */
buf[offset++] = payload->length; /* LI of user data */ buf[offset++] = payload->length; /* LI of user data */
buffer->partLength = offset; buffer->partLength = offset;
buffer->length = payload->length + offset; buffer->length = payload->length + offset;
@ -418,6 +455,20 @@ IsoSession_createAcceptSpdu(IsoSession* self, BufferChain buffer, BufferChain pa
buffer->nextPart = payload; buffer->nextPart = payload;
} }
void
IsoSession_createRefuseSpdu(IsoSession* self, BufferChain buffer, BufferChain payload, uint8_t reasonCode)
{
int offset = 0;
uint8_t* buf = buffer->buffer;
int lengthOffset;
buf[offset++] = 12; /* REFUSE SPDU */
lengthOffset = offset;
offset++;
offset = encodeConnectionIdentifier(buf, offset, reasonCode);
}
void void
IsoSession_init(IsoSession* session) IsoSession_init(IsoSession* session)
{ {
@ -446,20 +497,23 @@ IsoSession_parseMessage(IsoSession* self, ByteBuffer* message)
uint8_t id; uint8_t id;
uint8_t length; uint8_t length;
if (message->size > 1) { if (message->size > 1)
{
id = buffer[0]; id = buffer[0];
length = buffer[1]; length = buffer[1];
} }
else else
return SESSION_ERROR; return SESSION_ERROR;
switch (id) { switch (id)
{
case 13: /* CONNECT(CN) SPDU */ case 13: /* CONNECT(CN) SPDU */
if (length != (message->size - 2)) if (length != (message->size - 2))
return SESSION_ERROR; return SESSION_ERROR;
if (parseSessionHeaderParameters(self, message, length) == SESSION_OK) if (parseSessionHeaderParameters(self, message, length) == SESSION_OK)
return SESSION_CONNECT; return SESSION_CONNECT;
else { else
{
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: error parsing connect spdu\n"); printf("SESSION: error parsing connect spdu\n");
return SESSION_ERROR; return SESSION_ERROR;
@ -470,7 +524,8 @@ IsoSession_parseMessage(IsoSession* self, ByteBuffer* message)
return SESSION_ERROR; return SESSION_ERROR;
if (parseSessionHeaderParameters(self, message, length) == SESSION_OK) if (parseSessionHeaderParameters(self, message, length) == SESSION_OK)
return SESSION_CONNECT; return SESSION_CONNECT;
else { else
{
if (DEBUG_SESSION) if (DEBUG_SESSION)
printf("SESSION: error parsing accept spdu\n"); printf("SESSION: error parsing accept spdu\n");
return SESSION_ERROR; return SESSION_ERROR;
@ -481,7 +536,8 @@ IsoSession_parseMessage(IsoSession* self, ByteBuffer* message)
if (message->size < 4) if (message->size < 4)
return SESSION_ERROR; return SESSION_ERROR;
if ((length == 0) && (buffer[2] == 1) && (buffer[3] == 0)) { if ((length == 0) && (buffer[2] == 1) && (buffer[3] == 0))
{
ByteBuffer_wrap(&self->userData, message->buffer + 4, message->size - 4, message->maxSize - 4); ByteBuffer_wrap(&self->userData, message->buffer + 4, message->size - 4, message->maxSize - 4);
return SESSION_DATA; return SESSION_DATA;
@ -528,4 +584,3 @@ IsoSession_parseMessage(IsoSession* self, ByteBuffer* message)
return SESSION_ERROR; return SESSION_ERROR;
} }

Write Preview
Loading…
Cancel
Save