60#ifndef WHITEBOARD_POSTER_STRING_CONVERSION
61#define WHITEBOARD_POSTER_STRING_CONVERSION
72#pragma clang diagnostic push
73#pragma clang diagnostic ignored "-Wunused-macros"
77#elif defined(__APPLE__)
78# include <machine/endian.h>
79# include <architecture/byte_order.h>
80# define bswap_16(x) NXSwapShort(x)
81# define bswap_32(x) NXSwapInt(x)
82# define bswap_64(x) NXSwapLongLong(x)
84# define bswap_16(x) __builtin_bswap16(x)
85# define bswap_32(x) __builtin_bswap32(x)
86# define bswap_64(x) __builtin_bswap64(x)
91#if (!defined(__BYTE_ORDER) && !defined(__LITTLE_ENDIAN)) || (defined(__BYTE_ORDER) && defined(__LITTLE_ENDIAN) && __BYTE_ORDER == __LITTLE_ENDIAN)
92# if !defined(htonll) && !defined(ntohll)
93# define htonll(x) bswap_64(x)
94# define ntohll(x) bswap_64(x)
96# if !defined(htonl) && !defined(ntohl)
97# define htonl(x) bswap_32(x)
98# define ntohl(x) bswap_32(x)
100# if !defined(htons) && !defined(ntohs)
101# define htons(x) bswap_16(x)
102# define ntohs(x) bswap_16(x)
105# if !defined(htonll) && !defined(ntohll)
106# define htonll(x) (x)
107# define ntohll(x) (x)
109# if !defined(htonl) && !defined(ntohl)
113# if !defined(htons) && !defined(ntohs)
118#pragma clang diagnostic pop
127#pragma clang diagnostic push
128#pragma clang diagnostic ignored "-Wunused-variable"
130 if (len >= bufferSize) {
133 len += snprintf(descString + len, bufferSize - len,
"machineName=%s", self->machineName);
134 if (len >= bufferSize) {
137 len = gu_strlcat(descString,
", ", bufferSize);
138 if (len >= bufferSize) {
141 len += snprintf(descString + len, bufferSize - len,
"currentState=%u", self->currentState);
142 if (len >= bufferSize) {
145 len = gu_strlcat(descString,
", ", bufferSize);
146 if (len >= bufferSize) {
149 len += snprintf(descString + len, bufferSize - len,
"currentSection=%u", self->currentSection);
150 if (len >= bufferSize) {
153 len = gu_strlcat(descString,
", ", bufferSize);
154 if (len >= bufferSize) {
157 len += snprintf(descString + len, bufferSize - len,
"dataSet=%u", self->dataSet);
158 if (len >= bufferSize) {
161 len = gu_strlcat(descString,
", ", bufferSize);
162 if (len >= bufferSize) {
165 len = gu_strlcat(descString, self->loggerRunning ?
"loggerRunning=true" :
"loggerRunning=false", bufferSize);
166 if (len >= bufferSize) {
169 len = gu_strlcat(descString,
", ", bufferSize);
170 if (len >= bufferSize) {
173 len = gu_strlcat(descString, self->shouldExit ?
"shouldExit=true" :
"shouldExit=false", bufferSize);
174 if (len >= bufferSize) {
177 len = gu_strlcat(descString,
", ", bufferSize);
178 if (len >= bufferSize) {
181 len += snprintf(descString + len, bufferSize - len,
"comment=%s", self->comment);
183#pragma clang diagnostic pop
191#pragma clang diagnostic push
192#pragma clang diagnostic ignored "-Wunused-variable"
194 if (len >= bufferSize) {
197 len += snprintf(toString + len, bufferSize - len,
"%s", self->machineName);
198 if (len >= bufferSize) {
201 len = gu_strlcat(toString,
", ", bufferSize);
202 if (len >= bufferSize) {
205 len += snprintf(toString + len, bufferSize - len,
"%u", self->currentState);
206 if (len >= bufferSize) {
209 len = gu_strlcat(toString,
", ", bufferSize);
210 if (len >= bufferSize) {
213 len += snprintf(toString + len, bufferSize - len,
"%u", self->currentSection);
214 if (len >= bufferSize) {
217 len = gu_strlcat(toString,
", ", bufferSize);
218 if (len >= bufferSize) {
221 len += snprintf(toString + len, bufferSize - len,
"%u", self->dataSet);
222 if (len >= bufferSize) {
225 len = gu_strlcat(toString,
", ", bufferSize);
226 if (len >= bufferSize) {
229 len = gu_strlcat(toString, self->loggerRunning ?
"true" :
"false", bufferSize);
230 if (len >= bufferSize) {
233 len = gu_strlcat(toString,
", ", bufferSize);
234 if (len >= bufferSize) {
237 len = gu_strlcat(toString, self->shouldExit ?
"true" :
"false", bufferSize);
238 if (len >= bufferSize) {
241 len = gu_strlcat(toString,
", ", bufferSize);
242 if (len >= bufferSize) {
245 len += snprintf(toString + len, bufferSize - len,
"%s", self->comment);
247#pragma clang diagnostic pop
255 size_t temp_length = strlen(str);
256 int length = (temp_length <= INT_MAX) ? ((
int)((ssize_t)temp_length)) : -1;
261 char* var_str = &var_str_buffer[0];
263 char* key = &key_buffer[0];
270 if (index == 0 && str[0] ==
'{') {
276 for (
int i = index; i < length; i++) {
278 if (bracecount == 0 && str[i] ==
'=') {
283 if (bracecount == 0 && isspace(str[i])) {
290 if (bracecount == 0 && str[i] ==
',') {
300 if (bracecount < 0) {
305 if (i == length - 1) {
309 if (endKey >= startKey && endKey - startKey < length) {
310 strncpy(key, str + startKey, ((
size_t)(endKey - startKey) + 1));
311 key[(endKey - startKey) + 1] = 0;
315 strncpy(var_str, str + startVar, ((
size_t)(index - startVar) + 1));
316 var_str[(index - startVar) + 1] = 0;
322 if (strlen(key) > 0) {
323 if (0 == strcmp(
"machineName", key)) {
325 }
else if (0 == strcmp(
"currentState", key)) {
327 }
else if (0 == strcmp(
"currentSection", key)) {
329 }
else if (0 == strcmp(
"dataSet", key)) {
331 }
else if (0 == strcmp(
"loggerRunning", key)) {
333 }
else if (0 == strcmp(
"shouldExit", key)) {
335 }
else if (0 == strcmp(
"comment", key)) {
345 strncpy(self->machineName, var_str, 40);
350 self->currentState = ((uint32_t)atoi(var_str));
355 self->currentSection = ((uint32_t)atoi(var_str));
360 self->dataSet = ((uint8_t)atoi(var_str));
365 self->loggerRunning = strcmp(var_str,
"true") == 0 || strcmp(var_str,
"1") == 0;
370 self->shouldExit = strcmp(var_str,
"true") == 0 || strcmp(var_str,
"1") == 0;
375 strncpy(self->comment, var_str, 30);
382 }
while(index < length);
393 uint16_t bit_offset = 0;
395 uint8_t len = (uint8_t) strlen(self->machineName);
397 for (b = 7; b >= 0; b--) {
399 uint16_t
byte = bit_offset / 8;
400 uint16_t bit = 7 - (bit_offset % 8);
401 unsigned long newbit = !!((len >> b) & 1U);
402 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
403 bit_offset = bit_offset + 1;
407 for (c = 0; c < len; c++) {
408 for (b = 7; b >= 0; b--) {
410 uint16_t
byte = bit_offset / 8;
411 uint16_t bit = 7 - (bit_offset % 8);
412 unsigned long newbit = !!((
self->machineName[c] >> b) & 1U);
413 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
414 bit_offset = bit_offset + 1;
420 uint32_t currentState_nbo =
htonl(self->currentState);
423 for (b = (32 - 1); b >= 0; b--) {
425 uint16_t
byte = bit_offset / 8;
426 uint16_t bit = 7 - (bit_offset % 8);
427 unsigned long newbit = !!((currentState_nbo >> b) & 1U);
428 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
429 bit_offset = bit_offset + 1;
434 uint32_t currentSection_nbo =
htonl(self->currentSection);
437 for (b = (32 - 1); b >= 0; b--) {
439 uint16_t
byte = bit_offset / 8;
440 uint16_t bit = 7 - (bit_offset % 8);
441 unsigned long newbit = !!((currentSection_nbo >> b) & 1U);
442 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
443 bit_offset = bit_offset + 1;
448 uint8_t dataSet_nbo = (
self->dataSet);
451 for (b = (8 - 1); b >= 0; b--) {
453 uint16_t
byte = bit_offset / 8;
454 uint16_t bit = 7 - (bit_offset % 8);
455 unsigned long newbit = !!((dataSet_nbo >> b) & 1U);
456 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
457 bit_offset = bit_offset + 1;
463 uint16_t
byte = bit_offset / 8;
464 uint16_t bit = 7 - (bit_offset % 8);
465 unsigned long newbit = !!(
self->loggerRunning ? 1U : 0U);
466 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
467 bit_offset = bit_offset + 1;
471 uint16_t
byte = bit_offset / 8;
472 uint16_t bit = 7 - (bit_offset % 8);
473 unsigned long newbit = !!(
self->shouldExit ? 1U : 0U);
474 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
475 bit_offset = bit_offset + 1;
479 uint8_t len = (uint8_t) strlen(self->comment);
481 for (b = 7; b >= 0; b--) {
483 uint16_t
byte = bit_offset / 8;
484 uint16_t bit = 7 - (bit_offset % 8);
485 unsigned long newbit = !!((len >> b) & 1U);
486 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
487 bit_offset = bit_offset + 1;
491 for (c = 0; c < len; c++) {
492 for (b = 7; b >= 0; b--) {
494 uint16_t
byte = bit_offset / 8;
495 uint16_t bit = 7 - (bit_offset % 8);
496 unsigned long newbit = !!((
self->comment[c] >> b) & 1U);
497 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
498 bit_offset = bit_offset + 1;
514 uint16_t bit_offset = 0;
518 for (b = 7; b >= 0; b--) {
520 uint16_t
byte = bit_offset / 8;
521 uint16_t bit = 7 - (bit_offset % 8);
522 char dataByte = src[byte];
523 unsigned char bitValue = (dataByte >> bit) & 1U;
524 len ^= (-bitValue ^ len) & (1UL << b);
525 bit_offset = bit_offset + 1;
529 for (c = 0; c < len; c++) {
530 for (b = 7; b >= 0; b--) {
532 uint16_t
byte = bit_offset / 8;
533 uint16_t bit = 7 - (bit_offset % 8);
534 char dataByte = src[byte];
535 unsigned char bitValue = (dataByte >> bit) & 1U;
537 bit_offset = bit_offset + 1;
545 for (b = (32 - 1); b >= 0; b--) {
547 uint16_t
byte = bit_offset / 8;
548 uint16_t bit = 7 - (bit_offset % 8);
549 char dataByte = src[byte];
550 unsigned char bitValue = (dataByte >> bit) & 1U;
552 bit_offset = bit_offset + 1;
560 for (b = (32 - 1); b >= 0; b--) {
562 uint16_t
byte = bit_offset / 8;
563 uint16_t bit = 7 - (bit_offset % 8);
564 char dataByte = src[byte];
565 unsigned char bitValue = (dataByte >> bit) & 1U;
567 bit_offset = bit_offset + 1;
575 for (b = (8 - 1); b >= 0; b--) {
577 uint16_t
byte = bit_offset / 8;
578 uint16_t bit = 7 - (bit_offset % 8);
579 char dataByte = src[byte];
580 unsigned char bitValue = (dataByte >> bit) & 1U;
582 bit_offset = bit_offset + 1;
589 uint16_t
byte = bit_offset / 8;
590 uint16_t bit = 7 - (bit_offset % 8);
591 char dataByte = src[byte];
592 unsigned char bitValue = (dataByte >> bit) & 1U;
594 bit_offset = bit_offset + 1;
598 uint16_t
byte = bit_offset / 8;
599 uint16_t bit = 7 - (bit_offset % 8);
600 char dataByte = src[byte];
601 unsigned char bitValue = (dataByte >> bit) & 1U;
603 bit_offset = bit_offset + 1;
609 for (b = 7; b >= 0; b--) {
611 uint16_t
byte = bit_offset / 8;
612 uint16_t bit = 7 - (bit_offset % 8);
613 char dataByte = src[byte];
614 unsigned char bitValue = (dataByte >> bit) & 1U;
615 len ^= (-bitValue ^ len) & (1UL << b);
616 bit_offset = bit_offset + 1;
620 for (c = 0; c < len; c++) {
621 for (b = 7; b >= 0; b--) {
623 uint16_t
byte = bit_offset / 8;
624 uint16_t bit = 7 - (bit_offset % 8);
625 char dataByte = src[byte];
626 unsigned char bitValue = (dataByte >> bit) & 1U;
628 bit_offset = bit_offset + 1;
WHITEBOARD_POSTER_STRING_CONVERSION.
uint8_t dataSet
Enables selection of a data set to be logged (default = 0, joints and sensors) (NYI)
bool shouldExit
Switch to cause DataLogger to exit.
bool loggerRunning
Starts/Stops logging.
char machineName[40]
Name of the machine being monitored, but could be anything.
uint32_t currentSection
Section within the state (e.g.
char comment[30]
Comment to be attached to the logged data (NYI)
uint32_t currentState
The machine's currently executing state (use integer rather than the state's name)
const char * wb_data_logger_description(const struct wb_data_logger *self, char *descString, size_t bufferSize)
Convert to a description string.
size_t wb_data_logger_to_network_serialised(const struct wb_data_logger *self, char *dst)
Convert to a compressed, serialised, network byte order byte stream.
struct wb_data_logger * wb_data_logger_from_string(struct wb_data_logger *self, const char *str)
Convert from a string.
const char * wb_data_logger_to_string(const struct wb_data_logger *self, char *toString, size_t bufferSize)
Convert to a string.
size_t wb_data_logger_from_network_serialised(const char *src, struct wb_data_logger *dst)
Convert from a compressed, serialised, network byte order byte stream.
#define DATA_LOGGER_DESC_BUFFER_SIZE