blob: 54684b0a71d15348a4bfeb3237554a6a188db88e [file] [log] [blame]
/*
Licensed to the Apache Software Foundation (ASF) under one
or more contributor license agreements. See the NOTICE file
distributed with this work for additional information
regarding copyright ownership. The ASF licenses this file
to you under the Apache License, Version 2.0 (the
"License"); you may not use this file except in compliance
with the License. You may obtain a copy of the License at
http://www.apache.org/licenses/LICENSE-2.0
Unless required by applicable law or agreed to in writing,
software distributed under the License is distributed on an
"AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
KIND, either express or implied. See the License for the
specific language governing permissions and limitations
under the License.
*/
#include <stdio.h>
#include <plc4c/spi/evaluation_helper.h>
#include "cotp_packet.h"
// Array of discriminator values that match the enum type constants.
// (The order is identical to the enum constants so we can use the
// enum constant to directly access a given types discriminator values)
const plc4c_s7_read_write_cotp_packet_discriminator plc4c_s7_read_write_cotp_packet_discriminators[] = {
{/* plc4c_s7_read_write_cotp_packet_data */
.tpduCode = 0xF0},
{/* plc4c_s7_read_write_cotp_packet_connection_request */
.tpduCode = 0xE0},
{/* plc4c_s7_read_write_cotp_packet_connection_response */
.tpduCode = 0xD0},
{/* plc4c_s7_read_write_cotp_packet_disconnect_request */
.tpduCode = 0x80},
{/* plc4c_s7_read_write_cotp_packet_disconnect_response */
.tpduCode = 0xC0},
{/* plc4c_s7_read_write_cotp_packet_tpdu_error */
.tpduCode = 0x70}
};
// Function returning the discriminator values for a given type constant.
plc4c_s7_read_write_cotp_packet_discriminator plc4c_s7_read_write_cotp_packet_get_discriminator(plc4c_s7_read_write_cotp_packet_type type) {
return plc4c_s7_read_write_cotp_packet_discriminators[type];
}
// Create an empty NULL-struct
static const plc4c_s7_read_write_cotp_packet plc4c_s7_read_write_cotp_packet_null_const;
plc4c_s7_read_write_cotp_packet plc4c_s7_read_write_cotp_packet_null() {
return plc4c_s7_read_write_cotp_packet_null_const;
}
// Parse function.
plc4c_return_code plc4c_s7_read_write_cotp_packet_parse(plc4c_spi_read_buffer* io, uint16_t cotpLen, plc4c_s7_read_write_cotp_packet** _message) {
uint16_t startPos = plc4c_spi_read_get_pos(io);
uint16_t curPos;
plc4c_return_code _res = OK;
// Allocate enough memory to contain this data structure.
(*_message) = malloc(sizeof(plc4c_s7_read_write_cotp_packet));
if(*_message == NULL) {
return NO_MEMORY;
}
// Implicit Field (headerLength) (Used for parsing, but it's value is not stored as it's implicitly given by the objects content)
uint8_t headerLength = 0;
_res = plc4c_spi_read_unsigned_byte(io, 8, (uint8_t*) &headerLength);
if(_res != OK) {
return _res;
}
// Discriminator Field (tpduCode) (Used as input to a switch field)
uint8_t tpduCode = 0;
_res = plc4c_spi_read_unsigned_byte(io, 8, (uint8_t*) &tpduCode);
if(_res != OK) {
return _res;
}
// Switch Field (Depending on the discriminator values, passes the instantiation to a sub-type)
if(tpduCode == 0xF0) { /* COTPPacketData */
(*_message)->_type = plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_data;
// Simple Field (eot)
bool eot = false;
_res = plc4c_spi_read_bit(io, (bool*) &eot);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_data_eot = eot;
// Simple Field (tpduRef)
unsigned int tpduRef = 0;
_res = plc4c_spi_read_unsigned_byte(io, 7, (uint8_t*) &tpduRef);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_data_tpdu_ref = tpduRef;
} else
if(tpduCode == 0xE0) { /* COTPPacketConnectionRequest */
(*_message)->_type = plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_connection_request;
// Simple Field (destinationReference)
uint16_t destinationReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &destinationReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_connection_request_destination_reference = destinationReference;
// Simple Field (sourceReference)
uint16_t sourceReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &sourceReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_connection_request_source_reference = sourceReference;
// Enum field (protocolClass)
plc4c_s7_read_write_cotp_protocol_class protocolClass = plc4c_s7_read_write_cotp_protocol_class_null();
_res = plc4c_spi_read_signed_byte(io, 8, (int8_t*) &protocolClass);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_connection_request_protocol_class = protocolClass;
} else
if(tpduCode == 0xD0) { /* COTPPacketConnectionResponse */
(*_message)->_type = plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_connection_response;
// Simple Field (destinationReference)
uint16_t destinationReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &destinationReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_connection_response_destination_reference = destinationReference;
// Simple Field (sourceReference)
uint16_t sourceReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &sourceReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_connection_response_source_reference = sourceReference;
// Enum field (protocolClass)
plc4c_s7_read_write_cotp_protocol_class protocolClass = plc4c_s7_read_write_cotp_protocol_class_null();
_res = plc4c_spi_read_signed_byte(io, 8, (int8_t*) &protocolClass);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_connection_response_protocol_class = protocolClass;
} else
if(tpduCode == 0x80) { /* COTPPacketDisconnectRequest */
(*_message)->_type = plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_disconnect_request;
// Simple Field (destinationReference)
uint16_t destinationReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &destinationReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_disconnect_request_destination_reference = destinationReference;
// Simple Field (sourceReference)
uint16_t sourceReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &sourceReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_disconnect_request_source_reference = sourceReference;
// Enum field (protocolClass)
plc4c_s7_read_write_cotp_protocol_class protocolClass = plc4c_s7_read_write_cotp_protocol_class_null();
_res = plc4c_spi_read_signed_byte(io, 8, (int8_t*) &protocolClass);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_disconnect_request_protocol_class = protocolClass;
} else
if(tpduCode == 0xC0) { /* COTPPacketDisconnectResponse */
(*_message)->_type = plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_disconnect_response;
// Simple Field (destinationReference)
uint16_t destinationReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &destinationReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_disconnect_response_destination_reference = destinationReference;
// Simple Field (sourceReference)
uint16_t sourceReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &sourceReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_disconnect_response_source_reference = sourceReference;
} else
if(tpduCode == 0x70) { /* COTPPacketTpduError */
(*_message)->_type = plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_tpdu_error;
// Simple Field (destinationReference)
uint16_t destinationReference = 0;
_res = plc4c_spi_read_unsigned_short(io, 16, (uint16_t*) &destinationReference);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_tpdu_error_destination_reference = destinationReference;
// Simple Field (rejectCause)
uint8_t rejectCause = 0;
_res = plc4c_spi_read_unsigned_byte(io, 8, (uint8_t*) &rejectCause);
if(_res != OK) {
return _res;
}
(*_message)->cotp_packet_tpdu_error_reject_cause = rejectCause;
}
// Array field (parameters)
curPos = plc4c_spi_read_get_pos(io) - startPos;
plc4c_list* parameters = NULL;
plc4c_utils_list_create(&parameters);
if(parameters == NULL) {
return NO_MEMORY;
}
{
// Length array
uint8_t _parametersLength = (((headerLength) + (1))) - (curPos);
uint8_t parametersEndPos = plc4c_spi_read_get_pos(io) + _parametersLength;
while(plc4c_spi_read_get_pos(io) < parametersEndPos) {
plc4c_s7_read_write_cotp_parameter* _value = NULL;
_res = plc4c_s7_read_write_cotp_parameter_parse(io, (((headerLength) + (1))) - (curPos), (void*) &_value);
if(_res != OK) {
return _res;
}
plc4c_utils_list_insert_head_value(parameters, _value);
curPos = plc4c_spi_read_get_pos(io) - startPos;
}
}
(*_message)->parameters = parameters;
// Optional Field (payload) (Can be skipped, if a given expression evaluates to false)
curPos = plc4c_spi_read_get_pos(io) - startPos;
plc4c_s7_read_write_s7_message* payload = NULL;
if((curPos) < (cotpLen)) {
payload = malloc(sizeof(plc4c_s7_read_write_s7_message));
if(payload == NULL) {
return NO_MEMORY;
}
_res = plc4c_s7_read_write_s7_message_parse(io, &payload);
if(_res != OK) {
return _res;
}
(*_message)->payload = payload;
} else {
(*_message)->payload = NULL;
}
return OK;
}
plc4c_return_code plc4c_s7_read_write_cotp_packet_serialize(plc4c_spi_write_buffer* io, plc4c_s7_read_write_cotp_packet* _message) {
plc4c_return_code _res = OK;
// Implicit Field (headerLength) (Used for parsing, but it's value is not stored as it's implicitly given by the objects content)
_res = plc4c_spi_write_unsigned_byte(io, 8, (plc4c_s7_read_write_cotp_packet_length_in_bytes(_message)) - ((((((((_message->payload) != (NULL))) ? plc4c_s7_read_write_s7_message_length_in_bytes(_message->payload) : 0))) + (1))));
if(_res != OK) {
return _res;
}
// Discriminator Field (tpduCode)
plc4c_spi_write_unsigned_byte(io, 8, plc4c_s7_read_write_cotp_packet_get_discriminator(_message->_type).tpduCode);
// Switch Field (Depending of the current type, serialize the sub-type elements)
switch(_message->_type) {
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_data: {
// Simple Field (eot)
_res = plc4c_spi_write_bit(io, _message->cotp_packet_data_eot);
if(_res != OK) {
return _res;
}
// Simple Field (tpduRef)
_res = plc4c_spi_write_unsigned_byte(io, 7, _message->cotp_packet_data_tpdu_ref);
if(_res != OK) {
return _res;
}
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_connection_request: {
// Simple Field (destinationReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_connection_request_destination_reference);
if(_res != OK) {
return _res;
}
// Simple Field (sourceReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_connection_request_source_reference);
if(_res != OK) {
return _res;
}
// Enum field (protocolClass)
_res = plc4c_spi_write_signed_byte(io, 8, _message->cotp_packet_connection_request_protocol_class);
if(_res != OK) {
return _res;
}
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_connection_response: {
// Simple Field (destinationReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_connection_response_destination_reference);
if(_res != OK) {
return _res;
}
// Simple Field (sourceReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_connection_response_source_reference);
if(_res != OK) {
return _res;
}
// Enum field (protocolClass)
_res = plc4c_spi_write_signed_byte(io, 8, _message->cotp_packet_connection_response_protocol_class);
if(_res != OK) {
return _res;
}
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_disconnect_request: {
// Simple Field (destinationReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_disconnect_request_destination_reference);
if(_res != OK) {
return _res;
}
// Simple Field (sourceReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_disconnect_request_source_reference);
if(_res != OK) {
return _res;
}
// Enum field (protocolClass)
_res = plc4c_spi_write_signed_byte(io, 8, _message->cotp_packet_disconnect_request_protocol_class);
if(_res != OK) {
return _res;
}
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_disconnect_response: {
// Simple Field (destinationReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_disconnect_response_destination_reference);
if(_res != OK) {
return _res;
}
// Simple Field (sourceReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_disconnect_response_source_reference);
if(_res != OK) {
return _res;
}
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_tpdu_error: {
// Simple Field (destinationReference)
_res = plc4c_spi_write_unsigned_short(io, 16, _message->cotp_packet_tpdu_error_destination_reference);
if(_res != OK) {
return _res;
}
// Simple Field (rejectCause)
_res = plc4c_spi_write_unsigned_byte(io, 8, _message->cotp_packet_tpdu_error_reject_cause);
if(_res != OK) {
return _res;
}
break;
}
}
// Array field (parameters)
{
uint8_t itemCount = plc4c_utils_list_size(_message->parameters);
for(int curItem = 0; curItem < itemCount; curItem++) {
bool lastItem = curItem == (itemCount - 1);
plc4c_s7_read_write_cotp_parameter* _value = (plc4c_s7_read_write_cotp_parameter*) plc4c_utils_list_get_value(_message->parameters, curItem);
_res = plc4c_s7_read_write_cotp_parameter_serialize(io, (void*) _value);
if(_res != OK) {
return _res;
}
}
}
// Optional Field (payload)
if(_message->payload != NULL) {
_res = plc4c_s7_read_write_s7_message_serialize(io, _message->payload);
if(_res != OK) {
return _res;
}
}
return OK;
}
uint16_t plc4c_s7_read_write_cotp_packet_length_in_bytes(plc4c_s7_read_write_cotp_packet* _message) {
return plc4c_s7_read_write_cotp_packet_length_in_bits(_message) / 8;
}
uint16_t plc4c_s7_read_write_cotp_packet_length_in_bits(plc4c_s7_read_write_cotp_packet* _message) {
uint16_t lengthInBits = 0;
// Implicit Field (headerLength)
lengthInBits += 8;
// Discriminator Field (tpduCode)
lengthInBits += 8;
// Depending of the current type, add the length of sub-type elements ...
switch(_message->_type) {
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_data: {
// Simple field (eot)
lengthInBits += 1;
// Simple field (tpduRef)
lengthInBits += 7;
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_connection_request: {
// Simple field (destinationReference)
lengthInBits += 16;
// Simple field (sourceReference)
lengthInBits += 16;
// Enum Field (protocolClass)
lengthInBits += 8;
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_connection_response: {
// Simple field (destinationReference)
lengthInBits += 16;
// Simple field (sourceReference)
lengthInBits += 16;
// Enum Field (protocolClass)
lengthInBits += 8;
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_disconnect_request: {
// Simple field (destinationReference)
lengthInBits += 16;
// Simple field (sourceReference)
lengthInBits += 16;
// Enum Field (protocolClass)
lengthInBits += 8;
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_disconnect_response: {
// Simple field (destinationReference)
lengthInBits += 16;
// Simple field (sourceReference)
lengthInBits += 16;
break;
}
case plc4c_s7_read_write_cotp_packet_type_plc4c_s7_read_write_cotp_packet_tpdu_error: {
// Simple field (destinationReference)
lengthInBits += 16;
// Simple field (rejectCause)
lengthInBits += 8;
break;
}
}
// Array field
if(_message->parameters != NULL) {
plc4c_list_element* curElement = _message->parameters->tail;
while (curElement != NULL) {
lengthInBits += plc4c_s7_read_write_cotp_parameter_length_in_bits((plc4c_s7_read_write_cotp_parameter*) curElement->value);
curElement = curElement->next;
}
}
// Optional Field (payload)
if(_message->payload != NULL) {
lengthInBits += plc4c_s7_read_write_s7_message_length_in_bits(_message->payload);
}
return lengthInBits;
}