Steven Blair
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/
sv.c@1:9399d44c2b1a, 2011-10-07 (annotated)
- Committer:
- sblair
- Date:
- Fri Oct 07 13:48:18 2011 +0000
- Revision:
- 1:9399d44c2b1a
- Parent:
- 0:230c10b228ea
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| sblair | 1:9399d44c2b1a | 1 | /** |
| sblair | 1:9399d44c2b1a | 2 | * Rapid-prototyping protection schemes with IEC 61850 |
| sblair | 1:9399d44c2b1a | 3 | * |
| sblair | 1:9399d44c2b1a | 4 | * Copyright (c) 2011 Steven Blair |
| sblair | 1:9399d44c2b1a | 5 | * |
| sblair | 1:9399d44c2b1a | 6 | * This program is free software; you can redistribute it and/or |
| sblair | 1:9399d44c2b1a | 7 | * modify it under the terms of the GNU General Public License |
| sblair | 1:9399d44c2b1a | 8 | * as published by the Free Software Foundation; either version 2 |
| sblair | 1:9399d44c2b1a | 9 | * of the License, or (at your option) any later version. |
| sblair | 1:9399d44c2b1a | 10 | |
| sblair | 1:9399d44c2b1a | 11 | * This program is distributed in the hope that it will be useful, |
| sblair | 1:9399d44c2b1a | 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| sblair | 1:9399d44c2b1a | 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| sblair | 1:9399d44c2b1a | 14 | * GNU General Public License for more details. |
| sblair | 1:9399d44c2b1a | 15 | |
| sblair | 1:9399d44c2b1a | 16 | * You should have received a copy of the GNU General Public License |
| sblair | 1:9399d44c2b1a | 17 | * along with this program; if not, write to the Free Software |
| sblair | 1:9399d44c2b1a | 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
| sblair | 1:9399d44c2b1a | 19 | */ |
| sblair | 1:9399d44c2b1a | 20 | |
| sblair | 1:9399d44c2b1a | 21 | #include "sv.h" |
| sblair | 1:9399d44c2b1a | 22 | #include "svPacketData.h" |
| sblair | 1:9399d44c2b1a | 23 | #include "svDecode.h" |
| sblair | 0:230c10b228ea | 24 | #include "svEncode.h" |
| sblair | 0:230c10b228ea | 25 | |
| sblair | 1:9399d44c2b1a | 26 | struct svData Volt_11; |
| sblair | 1:9399d44c2b1a | 27 | struct svData rmxuCB_rmxu; |
| sblair | 1:9399d44c2b1a | 28 | |
| sblair | 0:230c10b228ea | 29 | |
| sblair | 0:230c10b228ea | 30 | |
| sblair | 0:230c10b228ea | 31 | |
| sblair | 1:9399d44c2b1a | 32 | // returns 1 if buf contains valid packet data |
| sblair | 1:9399d44c2b1a | 33 | int sv_update_Volt_11(unsigned char *buf) { |
| sblair | 1:9399d44c2b1a | 34 | int size = encode_11(Volt_11.ASDU[Volt_11.ASDUCount].data.data); |
| sblair | 1:9399d44c2b1a | 35 | Volt_11.ASDU[Volt_11.ASDUCount].data.size = size; |
| sblair | 1:9399d44c2b1a | 36 | |
| sblair | 1:9399d44c2b1a | 37 | Volt_11.ASDU[Volt_11.ASDUCount].smpCnt = Volt_11.sampleCountMaster; |
| sblair | 1:9399d44c2b1a | 38 | Volt_11.sampleCountMaster++; |
| sblair | 1:9399d44c2b1a | 39 | |
| sblair | 1:9399d44c2b1a | 40 | if (++Volt_11.ASDUCount == Volt_11.noASDU) { |
| sblair | 1:9399d44c2b1a | 41 | Volt_11.ASDUCount = 0; |
| sblair | 1:9399d44c2b1a | 42 | return svEncodePacket(&Volt_11, buf); |
| sblair | 1:9399d44c2b1a | 43 | } |
| sblair | 1:9399d44c2b1a | 44 | |
| sblair | 1:9399d44c2b1a | 45 | return 0; |
| sblair | 1:9399d44c2b1a | 46 | } |
| sblair | 1:9399d44c2b1a | 47 | |
| sblair | 1:9399d44c2b1a | 48 | // returns 1 if buf contains valid packet data |
| sblair | 1:9399d44c2b1a | 49 | int sv_update_rmxuCB_rmxu(unsigned char *buf) { |
| sblair | 1:9399d44c2b1a | 50 | int size = encode_rmxu(rmxuCB_rmxu.ASDU[rmxuCB_rmxu.ASDUCount].data.data); |
| sblair | 1:9399d44c2b1a | 51 | rmxuCB_rmxu.ASDU[rmxuCB_rmxu.ASDUCount].data.size = size; |
| sblair | 1:9399d44c2b1a | 52 | |
| sblair | 1:9399d44c2b1a | 53 | rmxuCB_rmxu.ASDU[rmxuCB_rmxu.ASDUCount].smpCnt = rmxuCB_rmxu.sampleCountMaster; |
| sblair | 1:9399d44c2b1a | 54 | rmxuCB_rmxu.sampleCountMaster++; |
| sblair | 1:9399d44c2b1a | 55 | |
| sblair | 1:9399d44c2b1a | 56 | if (++rmxuCB_rmxu.ASDUCount == rmxuCB_rmxu.noASDU) { |
| sblair | 1:9399d44c2b1a | 57 | rmxuCB_rmxu.ASDUCount = 0; |
| sblair | 1:9399d44c2b1a | 58 | return svEncodePacket(&rmxuCB_rmxu, buf); |
| sblair | 1:9399d44c2b1a | 59 | } |
| sblair | 1:9399d44c2b1a | 60 | |
| sblair | 1:9399d44c2b1a | 61 | return 0; |
| sblair | 1:9399d44c2b1a | 62 | } |
| sblair | 1:9399d44c2b1a | 63 | |
| sblair | 1:9399d44c2b1a | 64 | void init_sv() { |
| sblair | 1:9399d44c2b1a | 65 | int i = 0; |
| sblair | 0:230c10b228ea | 66 | |
| sblair | 1:9399d44c2b1a | 67 | Volt_11.noASDU = 2; |
| sblair | 1:9399d44c2b1a | 68 | Volt_11.ethHeaderData.destMACAddress[0] = 0x01; |
| sblair | 1:9399d44c2b1a | 69 | Volt_11.ethHeaderData.destMACAddress[1] = 0x0C; |
| sblair | 1:9399d44c2b1a | 70 | Volt_11.ethHeaderData.destMACAddress[2] = 0xCD; |
| sblair | 1:9399d44c2b1a | 71 | Volt_11.ethHeaderData.destMACAddress[3] = 0x04; |
| sblair | 1:9399d44c2b1a | 72 | Volt_11.ethHeaderData.destMACAddress[4] = 0x00; |
| sblair | 1:9399d44c2b1a | 73 | Volt_11.ethHeaderData.destMACAddress[5] = 0x01; |
| sblair | 1:9399d44c2b1a | 74 | Volt_11.ethHeaderData.APPID = 0x4000; |
| sblair | 1:9399d44c2b1a | 75 | Volt_11.ethHeaderData.VLAN_ID = 0x123; |
| sblair | 1:9399d44c2b1a | 76 | Volt_11.ethHeaderData.VLAN_PRIORITY = 0x4; |
| sblair | 1:9399d44c2b1a | 77 | Volt_11.ASDU = (struct ASDU *) malloc(2 * sizeof(struct ASDU)); |
| sblair | 1:9399d44c2b1a | 78 | for (i = 0; i < 2; i++) { |
| sblair | 1:9399d44c2b1a | 79 | Volt_11.ASDU[i].svID = (unsigned char *) malloc(3); |
| sblair | 1:9399d44c2b1a | 80 | strncpy((char *) Volt_11.ASDU[i].svID, "11\0", 3); |
| sblair | 1:9399d44c2b1a | 81 | Volt_11.ASDU[i].datset = (unsigned char *) malloc(4); |
| sblair | 1:9399d44c2b1a | 82 | strncpy((char *) Volt_11.ASDU[i].datset, "smv\0", 4); |
| sblair | 1:9399d44c2b1a | 83 | Volt_11.ASDU[i].smpCnt = 0; |
| sblair | 1:9399d44c2b1a | 84 | Volt_11.ASDU[i].confRev = 1; |
| sblair | 1:9399d44c2b1a | 85 | Volt_11.ASDU[i].smpSynch = 1; |
| sblair | 1:9399d44c2b1a | 86 | Volt_11.ASDU[i].smpRate = 4800; |
| sblair | 1:9399d44c2b1a | 87 | Volt_11.ASDU[i].data.size = 0; |
| sblair | 1:9399d44c2b1a | 88 | } |
| sblair | 1:9399d44c2b1a | 89 | Volt_11.ASDUCount = 0; |
| sblair | 1:9399d44c2b1a | 90 | |
| sblair | 1:9399d44c2b1a | 91 | rmxuCB_rmxu.noASDU = 16; |
| sblair | 1:9399d44c2b1a | 92 | rmxuCB_rmxu.ethHeaderData.destMACAddress[0] = 0x01; |
| sblair | 1:9399d44c2b1a | 93 | rmxuCB_rmxu.ethHeaderData.destMACAddress[1] = 0x0C; |
| sblair | 1:9399d44c2b1a | 94 | rmxuCB_rmxu.ethHeaderData.destMACAddress[2] = 0xCD; |
| sblair | 1:9399d44c2b1a | 95 | rmxuCB_rmxu.ethHeaderData.destMACAddress[3] = 0x04; |
| sblair | 1:9399d44c2b1a | 96 | rmxuCB_rmxu.ethHeaderData.destMACAddress[4] = 0x00; |
| sblair | 1:9399d44c2b1a | 97 | rmxuCB_rmxu.ethHeaderData.destMACAddress[5] = 0x01; |
| sblair | 1:9399d44c2b1a | 98 | rmxuCB_rmxu.ethHeaderData.APPID = 0x4000; |
| sblair | 1:9399d44c2b1a | 99 | rmxuCB_rmxu.ethHeaderData.VLAN_ID = 0x123; |
| sblair | 1:9399d44c2b1a | 100 | rmxuCB_rmxu.ethHeaderData.VLAN_PRIORITY = 0x4; |
| sblair | 1:9399d44c2b1a | 101 | rmxuCB_rmxu.ASDU = (struct ASDU *) malloc(16 * sizeof(struct ASDU)); |
| sblair | 1:9399d44c2b1a | 102 | for (i = 0; i < 16; i++) { |
| sblair | 1:9399d44c2b1a | 103 | rmxuCB_rmxu.ASDU[i].svID = (unsigned char *) malloc(5); |
| sblair | 1:9399d44c2b1a | 104 | strncpy((char *) rmxuCB_rmxu.ASDU[i].svID, "rmxu\0", 5); |
| sblair | 1:9399d44c2b1a | 105 | rmxuCB_rmxu.ASDU[i].datset = (unsigned char *) malloc(5); |
| sblair | 1:9399d44c2b1a | 106 | strncpy((char *) rmxuCB_rmxu.ASDU[i].datset, "rmxu\0", 5); |
| sblair | 1:9399d44c2b1a | 107 | rmxuCB_rmxu.ASDU[i].smpCnt = 0; |
| sblair | 1:9399d44c2b1a | 108 | rmxuCB_rmxu.ASDU[i].confRev = 1; |
| sblair | 1:9399d44c2b1a | 109 | rmxuCB_rmxu.ASDU[i].smpSynch = 1; |
| sblair | 1:9399d44c2b1a | 110 | rmxuCB_rmxu.ASDU[i].smpRate = 16; |
| sblair | 1:9399d44c2b1a | 111 | rmxuCB_rmxu.ASDU[i].data.size = 0; |
| sblair | 1:9399d44c2b1a | 112 | } |
| sblair | 1:9399d44c2b1a | 113 | rmxuCB_rmxu.ASDUCount = 0; |
| sblair | 1:9399d44c2b1a | 114 | } |
| sblair | 1:9399d44c2b1a | 115 |