/** Message related functions. * * @author Steffen Vogel * @copyright 2014-2020, Institute for Automation of Complex Power Systems, EONERC * @license GNU General Public License (version 3) * * VILLASnode * * This program is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . *********************************************************************************/ #include #include #include #include #include #include #include #include int villas_binary_sprint(struct io *io, char *buf, size_t len, size_t *wbytes, struct sample *smps[], unsigned cnt) { int ret; unsigned i = 0; char *ptr = buf; for (i = 0; i < cnt; i++) { struct msg *msg = (struct msg *) ptr; struct sample *smp = smps[i]; if (ptr + MSG_LEN(smp->length) > buf + len) break; ret = msg_from_sample(msg, smp, smp->signals); if (ret) return ret; if (io->flags & VILLAS_BINARY_WEB) { /** @todo convert to little endian */ } else msg_hton(msg); ptr += MSG_LEN(smp->length); } if (wbytes) *wbytes = ptr - buf; return i; } int villas_binary_sscan(struct io *io, const char *buf, size_t len, size_t *rbytes, struct sample *smps[], unsigned cnt) { int ret, values; unsigned i = 0; const char *ptr = buf; if (len % 4 != 0) return -1; /* Packet size is invalid: Must be multiple of 4 bytes */ for (i = 0; i < cnt; i++) { struct msg *msg = (struct msg *) ptr; struct sample *smp = smps[i]; smp->signals = io->signals; /* Complete buffer has been parsed */ if (ptr == buf + len) break; /* Check if header is still in buffer bounaries */ if (ptr + sizeof(struct msg) > buf + len) return -2; /* Invalid msg received */ values = (io->flags & VILLAS_BINARY_WEB) ? msg->length : ntohs(msg->length); /* Check if remainder of message is in buffer boundaries */ if (ptr + MSG_LEN(values) > buf + len) return -3; /*Invalid msg receive */ if (io->flags & VILLAS_BINARY_WEB) { /** @todo convert from little endian */ } else msg_ntoh(msg); ret = msg_to_sample(msg, smp, io->signals); if (ret) return ret; /* Invalid msg received */ ptr += MSG_LEN(smp->length); } if (rbytes) *rbytes = ptr - buf; return i; } static struct plugin p1; __attribute__((constructor(110))) static void UNIQUE(__ctor)() { p1.name = "villas.binary"; p1.description = "VILLAS binary network format"; p1.type = PluginType::FORMAT; p1.format.sprint = villas_binary_sprint; p1.format.sscan = villas_binary_sscan; p1.format.size = 0; p1.format.flags = (int) IOFlags::HAS_BINARY_PAYLOAD | (int) SampleFlags::HAS_TS_ORIGIN | (int) SampleFlags::HAS_SEQUENCE | (int) SampleFlags::HAS_DATA; vlist_push(&plugins, &p1); } __attribute__((destructor(110))) static void UNIQUE(__dtor)() { vlist_remove_all(&plugins, &p1); } /** The WebSocket node-type usually uses little endian byte order intead of network byte order */ static struct plugin p2; __attribute__((constructor(110))) static void UNIQUE(__ctor)() { p2.name = "villas.web"; p2.description = "VILLAS binary network format for WebSockets"; p2.type = PluginType::FORMAT; p2.format.sprint = villas_binary_sprint; p2.format.sscan = villas_binary_sscan; p2.format.size = 0; p2.format.flags = (int) IOFlags::HAS_BINARY_PAYLOAD | VILLAS_BINARY_WEB | (int) SampleFlags::HAS_TS_ORIGIN | (int) SampleFlags::HAS_SEQUENCE | (int) SampleFlags::HAS_DATA; vlist_push(&plugins, &p2); } __attribute__((destructor(110))) static void UNIQUE(__dtor)() { vlist_remove_all(&plugins, &p2); }