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,
"HeadYaw=%lf", (
double) self->HeadYaw);
134 if (len >= bufferSize) {
137 len = gu_strlcat(descString,
", ", bufferSize);
138 if (len >= bufferSize) {
141 len += snprintf(descString + len, bufferSize - len,
"HeadPitch=%lf", (
double) self->HeadPitch);
142 if (len >= bufferSize) {
145 len = gu_strlcat(descString,
", ", bufferSize);
146 if (len >= bufferSize) {
149 len += snprintf(descString + len, bufferSize - len,
"LShoulderPitch=%lf", (
double) self->LShoulderPitch);
150 if (len >= bufferSize) {
153 len = gu_strlcat(descString,
", ", bufferSize);
154 if (len >= bufferSize) {
157 len += snprintf(descString + len, bufferSize - len,
"LShoulderRoll=%lf", (
double) self->LShoulderRoll);
158 if (len >= bufferSize) {
161 len = gu_strlcat(descString,
", ", bufferSize);
162 if (len >= bufferSize) {
165 len += snprintf(descString + len, bufferSize - len,
"LElbowYaw=%lf", (
double) self->LElbowYaw);
166 if (len >= bufferSize) {
169 len = gu_strlcat(descString,
", ", bufferSize);
170 if (len >= bufferSize) {
173 len += snprintf(descString + len, bufferSize - len,
"LElbowRoll=%lf", (
double) self->LElbowRoll);
174 if (len >= bufferSize) {
177 len = gu_strlcat(descString,
", ", bufferSize);
178 if (len >= bufferSize) {
181 len += snprintf(descString + len, bufferSize - len,
"LWristYaw=%lf", (
double) self->LWristYaw);
182 if (len >= bufferSize) {
185 len = gu_strlcat(descString,
", ", bufferSize);
186 if (len >= bufferSize) {
189 len += snprintf(descString + len, bufferSize - len,
"LHand=%lf", (
double) self->LHand);
190 if (len >= bufferSize) {
193 len = gu_strlcat(descString,
", ", bufferSize);
194 if (len >= bufferSize) {
197 len += snprintf(descString + len, bufferSize - len,
"RShoulderPitch=%lf", (
double) self->RShoulderPitch);
198 if (len >= bufferSize) {
201 len = gu_strlcat(descString,
", ", bufferSize);
202 if (len >= bufferSize) {
205 len += snprintf(descString + len, bufferSize - len,
"RShoulderRoll=%lf", (
double) self->RShoulderRoll);
206 if (len >= bufferSize) {
209 len = gu_strlcat(descString,
", ", bufferSize);
210 if (len >= bufferSize) {
213 len += snprintf(descString + len, bufferSize - len,
"RElbowYaw=%lf", (
double) self->RElbowYaw);
214 if (len >= bufferSize) {
217 len = gu_strlcat(descString,
", ", bufferSize);
218 if (len >= bufferSize) {
221 len += snprintf(descString + len, bufferSize - len,
"RElbowRoll=%lf", (
double) self->RElbowRoll);
222 if (len >= bufferSize) {
225 len = gu_strlcat(descString,
", ", bufferSize);
226 if (len >= bufferSize) {
229 len += snprintf(descString + len, bufferSize - len,
"RWristYaw=%lf", (
double) self->RWristYaw);
230 if (len >= bufferSize) {
233 len = gu_strlcat(descString,
", ", bufferSize);
234 if (len >= bufferSize) {
237 len += snprintf(descString + len, bufferSize - len,
"RHand=%lf", (
double) self->RHand);
238 if (len >= bufferSize) {
241 len = gu_strlcat(descString,
", ", bufferSize);
242 if (len >= bufferSize) {
245 len += snprintf(descString + len, bufferSize - len,
"LHipYawPitch=%lf", (
double) self->LHipYawPitch);
246 if (len >= bufferSize) {
249 len = gu_strlcat(descString,
", ", bufferSize);
250 if (len >= bufferSize) {
253 len += snprintf(descString + len, bufferSize - len,
"LHipRoll=%lf", (
double) self->LHipRoll);
254 if (len >= bufferSize) {
257 len = gu_strlcat(descString,
", ", bufferSize);
258 if (len >= bufferSize) {
261 len += snprintf(descString + len, bufferSize - len,
"LHipPitch=%lf", (
double) self->LHipPitch);
262 if (len >= bufferSize) {
265 len = gu_strlcat(descString,
", ", bufferSize);
266 if (len >= bufferSize) {
269 len += snprintf(descString + len, bufferSize - len,
"LKneePitch=%lf", (
double) self->LKneePitch);
270 if (len >= bufferSize) {
273 len = gu_strlcat(descString,
", ", bufferSize);
274 if (len >= bufferSize) {
277 len += snprintf(descString + len, bufferSize - len,
"LAnklePitch=%lf", (
double) self->LAnklePitch);
278 if (len >= bufferSize) {
281 len = gu_strlcat(descString,
", ", bufferSize);
282 if (len >= bufferSize) {
285 len += snprintf(descString + len, bufferSize - len,
"LAnkleRoll=%lf", (
double) self->LAnkleRoll);
286 if (len >= bufferSize) {
289 len = gu_strlcat(descString,
", ", bufferSize);
290 if (len >= bufferSize) {
293 len += snprintf(descString + len, bufferSize - len,
"RHipRoll=%lf", (
double) self->RHipRoll);
294 if (len >= bufferSize) {
297 len = gu_strlcat(descString,
", ", bufferSize);
298 if (len >= bufferSize) {
301 len += snprintf(descString + len, bufferSize - len,
"RHipPitch=%lf", (
double) self->RHipPitch);
302 if (len >= bufferSize) {
305 len = gu_strlcat(descString,
", ", bufferSize);
306 if (len >= bufferSize) {
309 len += snprintf(descString + len, bufferSize - len,
"RKneePitch=%lf", (
double) self->RKneePitch);
310 if (len >= bufferSize) {
313 len = gu_strlcat(descString,
", ", bufferSize);
314 if (len >= bufferSize) {
317 len += snprintf(descString + len, bufferSize - len,
"RAnklePitch=%lf", (
double) self->RAnklePitch);
318 if (len >= bufferSize) {
321 len = gu_strlcat(descString,
", ", bufferSize);
322 if (len >= bufferSize) {
325 len += snprintf(descString + len, bufferSize - len,
"RAnkleRoll=%lf", (
double) self->RAnkleRoll);
327#pragma clang diagnostic pop
335#pragma clang diagnostic push
336#pragma clang diagnostic ignored "-Wunused-variable"
338 if (len >= bufferSize) {
341 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->HeadYaw);
342 if (len >= bufferSize) {
345 len = gu_strlcat(toString,
", ", bufferSize);
346 if (len >= bufferSize) {
349 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->HeadPitch);
350 if (len >= bufferSize) {
353 len = gu_strlcat(toString,
", ", bufferSize);
354 if (len >= bufferSize) {
357 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LShoulderPitch);
358 if (len >= bufferSize) {
361 len = gu_strlcat(toString,
", ", bufferSize);
362 if (len >= bufferSize) {
365 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LShoulderRoll);
366 if (len >= bufferSize) {
369 len = gu_strlcat(toString,
", ", bufferSize);
370 if (len >= bufferSize) {
373 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LElbowYaw);
374 if (len >= bufferSize) {
377 len = gu_strlcat(toString,
", ", bufferSize);
378 if (len >= bufferSize) {
381 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LElbowRoll);
382 if (len >= bufferSize) {
385 len = gu_strlcat(toString,
", ", bufferSize);
386 if (len >= bufferSize) {
389 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LWristYaw);
390 if (len >= bufferSize) {
393 len = gu_strlcat(toString,
", ", bufferSize);
394 if (len >= bufferSize) {
397 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LHand);
398 if (len >= bufferSize) {
401 len = gu_strlcat(toString,
", ", bufferSize);
402 if (len >= bufferSize) {
405 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RShoulderPitch);
406 if (len >= bufferSize) {
409 len = gu_strlcat(toString,
", ", bufferSize);
410 if (len >= bufferSize) {
413 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RShoulderRoll);
414 if (len >= bufferSize) {
417 len = gu_strlcat(toString,
", ", bufferSize);
418 if (len >= bufferSize) {
421 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RElbowYaw);
422 if (len >= bufferSize) {
425 len = gu_strlcat(toString,
", ", bufferSize);
426 if (len >= bufferSize) {
429 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RElbowRoll);
430 if (len >= bufferSize) {
433 len = gu_strlcat(toString,
", ", bufferSize);
434 if (len >= bufferSize) {
437 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RWristYaw);
438 if (len >= bufferSize) {
441 len = gu_strlcat(toString,
", ", bufferSize);
442 if (len >= bufferSize) {
445 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RHand);
446 if (len >= bufferSize) {
449 len = gu_strlcat(toString,
", ", bufferSize);
450 if (len >= bufferSize) {
453 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LHipYawPitch);
454 if (len >= bufferSize) {
457 len = gu_strlcat(toString,
", ", bufferSize);
458 if (len >= bufferSize) {
461 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LHipRoll);
462 if (len >= bufferSize) {
465 len = gu_strlcat(toString,
", ", bufferSize);
466 if (len >= bufferSize) {
469 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LHipPitch);
470 if (len >= bufferSize) {
473 len = gu_strlcat(toString,
", ", bufferSize);
474 if (len >= bufferSize) {
477 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LKneePitch);
478 if (len >= bufferSize) {
481 len = gu_strlcat(toString,
", ", bufferSize);
482 if (len >= bufferSize) {
485 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LAnklePitch);
486 if (len >= bufferSize) {
489 len = gu_strlcat(toString,
", ", bufferSize);
490 if (len >= bufferSize) {
493 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->LAnkleRoll);
494 if (len >= bufferSize) {
497 len = gu_strlcat(toString,
", ", bufferSize);
498 if (len >= bufferSize) {
501 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RHipRoll);
502 if (len >= bufferSize) {
505 len = gu_strlcat(toString,
", ", bufferSize);
506 if (len >= bufferSize) {
509 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RHipPitch);
510 if (len >= bufferSize) {
513 len = gu_strlcat(toString,
", ", bufferSize);
514 if (len >= bufferSize) {
517 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RKneePitch);
518 if (len >= bufferSize) {
521 len = gu_strlcat(toString,
", ", bufferSize);
522 if (len >= bufferSize) {
525 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RAnklePitch);
526 if (len >= bufferSize) {
529 len = gu_strlcat(toString,
", ", bufferSize);
530 if (len >= bufferSize) {
533 len += snprintf(toString + len, bufferSize - len,
"%lf", (
double) self->RAnkleRoll);
535#pragma clang diagnostic pop
543 size_t temp_length = strlen(str);
544 int length = (temp_length <= INT_MAX) ? ((
int)((ssize_t)temp_length)) : -1;
549 char* var_str = &var_str_buffer[0];
551 char* key = &key_buffer[0];
558 if (index == 0 && str[0] ==
'{') {
564 for (
int i = index; i < length; i++) {
566 if (bracecount == 0 && str[i] ==
'=') {
571 if (bracecount == 0 && isspace(str[i])) {
578 if (bracecount == 0 && str[i] ==
',') {
588 if (bracecount < 0) {
593 if (i == length - 1) {
597 if (endKey >= startKey && endKey - startKey < length) {
598 strncpy(key, str + startKey, ((
size_t)(endKey - startKey) + 1));
599 key[(endKey - startKey) + 1] = 0;
603 strncpy(var_str, str + startVar, ((
size_t)(index - startVar) + 1));
604 var_str[(index - startVar) + 1] = 0;
610 if (strlen(key) > 0) {
611 if (0 == strcmp(
"HeadYaw", key)) {
613 }
else if (0 == strcmp(
"HeadPitch", key)) {
615 }
else if (0 == strcmp(
"LShoulderPitch", key)) {
617 }
else if (0 == strcmp(
"LShoulderRoll", key)) {
619 }
else if (0 == strcmp(
"LElbowYaw", key)) {
621 }
else if (0 == strcmp(
"LElbowRoll", key)) {
623 }
else if (0 == strcmp(
"LWristYaw", key)) {
625 }
else if (0 == strcmp(
"LHand", key)) {
627 }
else if (0 == strcmp(
"RShoulderPitch", key)) {
629 }
else if (0 == strcmp(
"RShoulderRoll", key)) {
631 }
else if (0 == strcmp(
"RElbowYaw", key)) {
633 }
else if (0 == strcmp(
"RElbowRoll", key)) {
635 }
else if (0 == strcmp(
"RWristYaw", key)) {
637 }
else if (0 == strcmp(
"RHand", key)) {
639 }
else if (0 == strcmp(
"LHipYawPitch", key)) {
641 }
else if (0 == strcmp(
"LHipRoll", key)) {
643 }
else if (0 == strcmp(
"LHipPitch", key)) {
645 }
else if (0 == strcmp(
"LKneePitch", key)) {
647 }
else if (0 == strcmp(
"LAnklePitch", key)) {
649 }
else if (0 == strcmp(
"LAnkleRoll", key)) {
651 }
else if (0 == strcmp(
"RHipRoll", key)) {
653 }
else if (0 == strcmp(
"RHipPitch", key)) {
655 }
else if (0 == strcmp(
"RKneePitch", key)) {
657 }
else if (0 == strcmp(
"RAnklePitch", key)) {
659 }
else if (0 == strcmp(
"RAnkleRoll", key)) {
669 self->HeadYaw = ((float)atof(var_str));
674 self->HeadPitch = ((float)atof(var_str));
679 self->LShoulderPitch = ((float)atof(var_str));
684 self->LShoulderRoll = ((float)atof(var_str));
689 self->LElbowYaw = ((float)atof(var_str));
694 self->LElbowRoll = ((float)atof(var_str));
699 self->LWristYaw = ((float)atof(var_str));
704 self->LHand = ((float)atof(var_str));
709 self->RShoulderPitch = ((float)atof(var_str));
714 self->RShoulderRoll = ((float)atof(var_str));
719 self->RElbowYaw = ((float)atof(var_str));
724 self->RElbowRoll = ((float)atof(var_str));
729 self->RWristYaw = ((float)atof(var_str));
734 self->RHand = ((float)atof(var_str));
739 self->LHipYawPitch = ((float)atof(var_str));
744 self->LHipRoll = ((float)atof(var_str));
749 self->LHipPitch = ((float)atof(var_str));
754 self->LKneePitch = ((float)atof(var_str));
759 self->LAnklePitch = ((float)atof(var_str));
764 self->LAnkleRoll = ((float)atof(var_str));
769 self->RHipRoll = ((float)atof(var_str));
774 self->RHipPitch = ((float)atof(var_str));
779 self->RKneePitch = ((float)atof(var_str));
784 self->RAnklePitch = ((float)atof(var_str));
789 self->RAnkleRoll = ((float)atof(var_str));
796 }
while(index < length);
807 uint16_t bit_offset = 0;
868 uint16_t bit_offset = 0;
WHITEBOARD_POSTER_STRING_CONVERSION.
size_t wb_nao_joint_list_float_from_network_serialised(const char *src, struct wb_nao_joint_list_float *dst)
Convert from a compressed, serialised, network byte order byte stream.
const char * wb_nao_joint_list_float_description(const struct wb_nao_joint_list_float *self, char *descString, size_t bufferSize)
Convert to a description string.
struct wb_nao_joint_list_float * wb_nao_joint_list_float_from_string(struct wb_nao_joint_list_float *self, const char *str)
Convert from a string.
size_t wb_nao_joint_list_float_to_network_serialised(const struct wb_nao_joint_list_float *self, char *dst)
Convert to a compressed, serialised, network byte order byte stream.
const char * wb_nao_joint_list_float_to_string(const struct wb_nao_joint_list_float *self, char *toString, size_t bufferSize)
Convert to a string.
#define NAO_JOINT_LIST_FLOAT_DESC_BUFFER_SIZE