Steven Blair / rapid61850example

The goal of this software is to automatically generate C/C++ code which reads and writes GOOSE and Sampled Value packets. Any valid IEC 61850 Substation Configuration Description (SCD) file, describing GOOSE and/or SV communications, can be used as the input. The output code is lightweight and platform-independent, so it can run on a variety of devices, including low-cost microcontrollers. It\'s ideal for rapid-prototyping new protection and control systems that require communications. This mbed project is a simple example of this functionality. Other code: https://github.com/stevenblair/rapid61850 Project homepage: http://personal.strath.ac.uk/steven.m.blair/

gseEncodeBasic.c

Committer:
sblair
Date:
2011-10-07
Revision:
0:230c10b228ea
Child:
1:9399d44c2b1a

File content as of revision 0:230c10b228ea:

#ifndef GSE_BER_ENCODE_BASIC_C
#define GSE_BER_ENCODE_BASIC_C

#include "ctypes.h"
#include "datatypes.h"
#include "ied.h"
#include "gseEncodeBasic.h"

#include <stdlib.h>
#include <stdio.h>

// BER encoding of basic types
int BER_ENCODE_CTYPE_FLOAT32(unsigned char *buf, CTYPE_FLOAT32 *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_FLOAT32(value);

	buf[offset++] = ASN1_TAG_FLOATING_POINT;
	offset += encodeLength(&buf[offset], len);

	buf[offset++] = 0x08;	// bits for exponent
	netmemcpy(&buf[offset], value, len - 1);

	return offset + len - 1;
}
int BER_ENCODE_CTYPE_FLOAT64(unsigned char *buf, CTYPE_FLOAT64 *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_FLOAT64(value);

	buf[offset++] = ASN1_TAG_FLOATING_POINT;
	offset += encodeLength(&buf[offset], len);

	buf[offset++] = 0x0B;	// bits for exponent
	netmemcpy(&buf[offset], value, len - 1);

	return offset + len - 1;
}
int BER_ENCODE_CTYPE_QUALITY(unsigned char *buf, CTYPE_QUALITY *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_QUALITY(value);

	buf[offset++] = ASN1_TAG_BIT_STRING;
	offset += encodeLength(&buf[offset], len - 1);

	buf[offset++] = QUALITY_UNUSED_BITS;	// number of unused bits
	netmemcpy(&buf[offset], value, len - 1);

	return offset + len - 1;
}
int BER_ENCODE_CTYPE_TIMESTAMP(unsigned char *buf, CTYPE_TIMESTAMP *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_TIMESTAMP(value);

	buf[offset++] = ASN1_TAG_OCTET_STRING;
	offset += encodeLength(&buf[offset], len);

	memcpy(&buf[offset], value, len);	//TODO should be memcpy, because already in big-endian?

	return offset + len;
}
int BER_ENCODE_CTYPE_ENUM(unsigned char *buf, CTYPE_ENUM *value) {	// assuming enum is an int - allows any enum type to be used
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_ENUM(value);

	buf[offset++] = ASN1_TAG_INTEGER;
	offset += encodeLength(&buf[offset], len);

	ber_encode_integer(&buf[offset], value, SV_GET_LENGTH_INT32U);
	//netmemcpy(&buf[offset], value, len);

	return offset + len;
}
int BER_ENCODE_CTYPE_INT16(unsigned char *buf, CTYPE_INT16 *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_INT16(value);

	buf[offset++] = ASN1_TAG_INTEGER;
	offset += encodeLength(&buf[offset], len);

	ber_encode_integer(&buf[offset], value, SV_GET_LENGTH_INT16);
	//netmemcpy(&buf[offset], value, len);

	return offset + len;
}
int BER_ENCODE_CTYPE_INT32(unsigned char *buf, CTYPE_INT32 *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_INT32(value);

	buf[offset++] = ASN1_TAG_INTEGER;
	offset += encodeLength(&buf[offset], len);

	printf("INT32 value: %u, len: %i, total: %i\n", *value, len, offset + len);
	fflush(stdout);
	ber_encode_integer(&buf[offset], value, SV_GET_LENGTH_INT32);
	//netmemcpy(&buf[offset], value, len);

	return offset + len;
}
int BER_ENCODE_CTYPE_INT16U(unsigned char *buf, CTYPE_INT16U *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_INT16U(value);

	buf[offset++] = ASN1_TAG_UNSIGNED;
	offset += encodeLength(&buf[offset], len);

	printf("INT16U value: %u, len: %i, total: %i\n", *value, len, offset + len);
	fflush(stdout);
	ber_encode_integer(&buf[offset], value, SV_GET_LENGTH_INT16U);
	//netmemcpy(&buf[offset], value, len);

	return offset + len;
}
int BER_ENCODE_CTYPE_INT32U(unsigned char *buf, CTYPE_INT32U *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_INT32U(value);

	buf[offset++] = ASN1_TAG_UNSIGNED;
	offset += encodeLength(&buf[offset], len);

	ber_encode_integer(&buf[offset], value, SV_GET_LENGTH_INT32U);

	printf("INT32U value: %u, len: %i, total: %i\n", *value, len, offset + len);
	fflush(stdout);
	//netmemcpy(&buf[offset], value, len);

	return offset + len;
}
int BER_ENCODE_CTYPE_VISSTRING255(unsigned char *buf, CTYPE_VISSTRING255 *value) {
	netmemcpy(buf, value, BER_GET_LENGTH_CTYPE_VISSTRING255(value));

	return BER_GET_LENGTH_CTYPE_VISSTRING255(value);
}
int BER_ENCODE_CTYPE_BOOLEAN(unsigned char *buf, CTYPE_BOOLEAN *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_BOOLEAN(value);

	buf[offset++] = ASN1_TAG_BOOLEAN;
	offset += encodeLength(&buf[offset], len);

	netmemcpy(&buf[offset], value, len);

	return offset + len;
}
int BER_ENCODE_CTYPE_DBPOS(unsigned char *buf, CTYPE_DBPOS *value) {
	CTYPE_INT16U offset = 0;
	CTYPE_INT16U len = BER_GET_LENGTH_CTYPE_DBPOS(value);

	buf[offset++] = 0x85;
	offset += encodeLength(&buf[offset], len);

	netmemcpy(&buf[offset], value, len);	//TODO should be memcpy, because already in big-endian?

	return offset + len;
}

#endif