gusimplewhiteboard
wb_nao_sonar_protected_walk_command.c
Go to the documentation of this file.
1/*
2 * file wb_nao_sonar_protected_walk_command.c
3 *
4 * This file was generated by classgenerator from nao_sonar_protected_walk_command.gen.
5 * DO NOT CHANGE MANUALLY!
6 *
7 * Copyright © 2021 Vlad Estivill-Castro. All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 *
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 *
16 * 2. Redistributions in binary form must reproduce the above
17 * copyright notice, this list of conditions and the following
18 * disclaimer in the documentation and/or other materials
19 * provided with the distribution.
20 *
21 * 3. All advertising materials mentioning features or use of this
22 * software must display the following acknowledgement:
23 *
24 * This product includes software developed by Vlad Estivill-Castro.
25 *
26 * 4. Neither the name of the author nor the names of contributors
27 * may be used to endorse or promote products derived from this
28 * software without specific prior written permission.
29 *
30 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
31 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
32 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
33 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
34 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
35 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
36 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
37 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
38 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
39 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
40 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
41 *
42 * -----------------------------------------------------------------------
43 * This program is free software; you can redistribute it and/or
44 * modify it under the above terms or under the terms of the GNU
45 * General Public License as published by the Free Software Foundation;
46 * either version 2 of the License, or (at your option) any later version.
47 *
48 * This program is distributed in the hope that it will be useful,
49 * but WITHOUT ANY WARRANTY; without even the implied warranty of
50 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
51 * GNU General Public License for more details.
52 *
53 * You should have received a copy of the GNU General Public License
54 * along with this program; if not, see http://www.gnu.org/licenses/
55 * or write to the Free Software Foundation, Inc., 51 Franklin Street,
56 * Fifth Floor, Boston, MA 02110-1301, USA.
57 *
58 */
59
60#ifndef WHITEBOARD_POSTER_STRING_CONVERSION
61#define WHITEBOARD_POSTER_STRING_CONVERSION
62#endif // WHITEBOARD_POSTER_STRING_CONVERSION
63
65#include <stdio.h>
66#include <string.h>
67#include <stdlib.h>
68#include <ctype.h>
69#include <limits.h>
70
71/* Network byte order functions */
72#pragma clang diagnostic push
73#pragma clang diagnostic ignored "-Wunused-macros"
74#if defined(__linux)
75# include <endian.h>
76# include <byteswap.h>
77#elif defined(__APPLE__)
78# include <machine/endian.h> //Needed for __BYTE_ORDER
79# include <architecture/byte_order.h> //Needed for byte swap functions
80# define bswap_16(x) NXSwapShort(x)
81# define bswap_32(x) NXSwapInt(x)
82# define bswap_64(x) NXSwapLongLong(x)
83#elif defined(ESP8266)
84# define bswap_16(x) __builtin_bswap16(x)
85# define bswap_32(x) __builtin_bswap32(x)
86# define bswap_64(x) __builtin_bswap64(x)
87#else
88 //Manually define swap macros?
89#endif
90
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)
95# endif
96# if !defined(htonl) && !defined(ntohl)
97# define htonl(x) bswap_32(x)
98# define ntohl(x) bswap_32(x)
99# endif
100# if !defined(htons) && !defined(ntohs)
101# define htons(x) bswap_16(x)
102# define ntohs(x) bswap_16(x)
103# endif
104#else
105# if !defined(htonll) && !defined(ntohll)
106# define htonll(x) (x)
107# define ntohll(x) (x)
108# endif
109# if !defined(htonl) && !defined(ntohl)
110# define htonl(x) (x)
111# define ntohl(x) (x)
112# endif
113# if !defined(htons) && !defined(ntohs)
114# define htons(x) (x)
115# define ntohs(x) (x)
116# endif
117#endif
118#pragma clang diagnostic pop
119
120
121
125const char* wb_nao_sonar_protected_walk_command_description(const struct wb_nao_sonar_protected_walk_command* self, char* descString, size_t bufferSize)
126{
127#pragma clang diagnostic push
128#pragma clang diagnostic ignored "-Wunused-variable"
129 size_t len = 0;
130 if (len >= bufferSize) {
131 return descString;
132 }
133 len = gu_strlcat(descString, self->walkEngineOn ? "walkEngineOn=true" : "walkEngineOn=false", bufferSize);
134 if (len >= bufferSize) {
135 return descString;
136 }
137 len = gu_strlcat(descString, ", ", bufferSize);
138 if (len >= bufferSize) {
139 return descString;
140 }
141 len += snprintf(descString + len, bufferSize - len, "forward=%d", self->forward);
142 if (len >= bufferSize) {
143 return descString;
144 }
145 len = gu_strlcat(descString, ", ", bufferSize);
146 if (len >= bufferSize) {
147 return descString;
148 }
149 len += snprintf(descString + len, bufferSize - len, "left=%d", self->left);
150 if (len >= bufferSize) {
151 return descString;
152 }
153 len = gu_strlcat(descString, ", ", bufferSize);
154 if (len >= bufferSize) {
155 return descString;
156 }
157 len += snprintf(descString + len, bufferSize - len, "turn=%d", self->turn);
158 if (len >= bufferSize) {
159 return descString;
160 }
161 len = gu_strlcat(descString, ", ", bufferSize);
162 if (len >= bufferSize) {
163 return descString;
164 }
165 len += snprintf(descString + len, bufferSize - len, "priority=%d", self->priority);
166 if (len >= bufferSize) {
167 return descString;
168 }
169 len = gu_strlcat(descString, ", ", bufferSize);
170 if (len >= bufferSize) {
171 return descString;
172 }
173 len = gu_strlcat(descString, self->exactStepsRequested ? "exactStepsRequested=true" : "exactStepsRequested=false", bufferSize);
174 if (len >= bufferSize) {
175 return descString;
176 }
177 len = gu_strlcat(descString, ", ", bufferSize);
178 if (len >= bufferSize) {
179 return descString;
180 }
181 len += snprintf(descString + len, bufferSize - len, "speed=%u", self->speed);
182 if (len >= bufferSize) {
183 return descString;
184 }
185 len = gu_strlcat(descString, ", ", bufferSize);
186 if (len >= bufferSize) {
187 return descString;
188 }
189 len = gu_strlcat(descString, self->isFast ? "isFast=true" : "isFast=false", bufferSize);
190 if (len >= bufferSize) {
191 return descString;
192 }
193 len = gu_strlcat(descString, ", ", bufferSize);
194 if (len >= bufferSize) {
195 return descString;
196 }
197 len = gu_strlcat(descString, self->kickWithLeftFoot ? "kickWithLeftFoot=true" : "kickWithLeftFoot=false", bufferSize);
198 if (len >= bufferSize) {
199 return descString;
200 }
201 len = gu_strlcat(descString, ", ", bufferSize);
202 if (len >= bufferSize) {
203 return descString;
204 }
205 len = gu_strlcat(descString, self->useShuffle ? "useShuffle=true" : "useShuffle=false", bufferSize);
206 if (len >= bufferSize) {
207 return descString;
208 }
209 len = gu_strlcat(descString, ", ", bufferSize);
210 if (len >= bufferSize) {
211 return descString;
212 }
213 len = gu_strlcat(descString, self->leftArmLimp ? "leftArmLimp=true" : "leftArmLimp=false", bufferSize);
214 if (len >= bufferSize) {
215 return descString;
216 }
217 len = gu_strlcat(descString, ", ", bufferSize);
218 if (len >= bufferSize) {
219 return descString;
220 }
221 len = gu_strlcat(descString, self->rightArmLimp ? "rightArmLimp=true" : "rightArmLimp=false", bufferSize);
222 if (len >= bufferSize) {
223 return descString;
224 }
225 len = gu_strlcat(descString, ", ", bufferSize);
226 if (len >= bufferSize) {
227 return descString;
228 }
229 len += snprintf(descString + len, bufferSize - len, "power=%u", self->power);
230 if (len >= bufferSize) {
231 return descString;
232 }
233 len = gu_strlcat(descString, ", ", bufferSize);
234 if (len >= bufferSize) {
235 return descString;
236 }
237 len += snprintf(descString + len, bufferSize - len, "odometryResetCounter=%u", self->odometryResetCounter);
238 if (len >= bufferSize) {
239 return descString;
240 }
241 len = gu_strlcat(descString, ", ", bufferSize);
242 if (len >= bufferSize) {
243 return descString;
244 }
245 len += snprintf(descString + len, bufferSize - len, "bend=%u", self->bend);
246 return descString;
247#pragma clang diagnostic pop
248}
249
253const char* wb_nao_sonar_protected_walk_command_to_string(const struct wb_nao_sonar_protected_walk_command* self, char* toString, size_t bufferSize)
254{
255#pragma clang diagnostic push
256#pragma clang diagnostic ignored "-Wunused-variable"
257 size_t len = 0;
258 if (len >= bufferSize) {
259 return toString;
260 }
261 len = gu_strlcat(toString, self->walkEngineOn ? "true" : "false", bufferSize);
262 if (len >= bufferSize) {
263 return toString;
264 }
265 len = gu_strlcat(toString, ", ", bufferSize);
266 if (len >= bufferSize) {
267 return toString;
268 }
269 len += snprintf(toString + len, bufferSize - len, "%d", self->forward);
270 if (len >= bufferSize) {
271 return toString;
272 }
273 len = gu_strlcat(toString, ", ", bufferSize);
274 if (len >= bufferSize) {
275 return toString;
276 }
277 len += snprintf(toString + len, bufferSize - len, "%d", self->left);
278 if (len >= bufferSize) {
279 return toString;
280 }
281 len = gu_strlcat(toString, ", ", bufferSize);
282 if (len >= bufferSize) {
283 return toString;
284 }
285 len += snprintf(toString + len, bufferSize - len, "%d", self->turn);
286 if (len >= bufferSize) {
287 return toString;
288 }
289 len = gu_strlcat(toString, ", ", bufferSize);
290 if (len >= bufferSize) {
291 return toString;
292 }
293 len += snprintf(toString + len, bufferSize - len, "%d", self->priority);
294 if (len >= bufferSize) {
295 return toString;
296 }
297 len = gu_strlcat(toString, ", ", bufferSize);
298 if (len >= bufferSize) {
299 return toString;
300 }
301 len = gu_strlcat(toString, self->exactStepsRequested ? "true" : "false", bufferSize);
302 if (len >= bufferSize) {
303 return toString;
304 }
305 len = gu_strlcat(toString, ", ", bufferSize);
306 if (len >= bufferSize) {
307 return toString;
308 }
309 len += snprintf(toString + len, bufferSize - len, "%u", self->speed);
310 if (len >= bufferSize) {
311 return toString;
312 }
313 len = gu_strlcat(toString, ", ", bufferSize);
314 if (len >= bufferSize) {
315 return toString;
316 }
317 len = gu_strlcat(toString, self->isFast ? "true" : "false", bufferSize);
318 if (len >= bufferSize) {
319 return toString;
320 }
321 len = gu_strlcat(toString, ", ", bufferSize);
322 if (len >= bufferSize) {
323 return toString;
324 }
325 len = gu_strlcat(toString, self->kickWithLeftFoot ? "true" : "false", bufferSize);
326 if (len >= bufferSize) {
327 return toString;
328 }
329 len = gu_strlcat(toString, ", ", bufferSize);
330 if (len >= bufferSize) {
331 return toString;
332 }
333 len = gu_strlcat(toString, self->useShuffle ? "true" : "false", bufferSize);
334 if (len >= bufferSize) {
335 return toString;
336 }
337 len = gu_strlcat(toString, ", ", bufferSize);
338 if (len >= bufferSize) {
339 return toString;
340 }
341 len = gu_strlcat(toString, self->leftArmLimp ? "true" : "false", bufferSize);
342 if (len >= bufferSize) {
343 return toString;
344 }
345 len = gu_strlcat(toString, ", ", bufferSize);
346 if (len >= bufferSize) {
347 return toString;
348 }
349 len = gu_strlcat(toString, self->rightArmLimp ? "true" : "false", bufferSize);
350 if (len >= bufferSize) {
351 return toString;
352 }
353 len = gu_strlcat(toString, ", ", bufferSize);
354 if (len >= bufferSize) {
355 return toString;
356 }
357 len += snprintf(toString + len, bufferSize - len, "%u", self->power);
358 if (len >= bufferSize) {
359 return toString;
360 }
361 len = gu_strlcat(toString, ", ", bufferSize);
362 if (len >= bufferSize) {
363 return toString;
364 }
365 len += snprintf(toString + len, bufferSize - len, "%u", self->odometryResetCounter);
366 if (len >= bufferSize) {
367 return toString;
368 }
369 len = gu_strlcat(toString, ", ", bufferSize);
370 if (len >= bufferSize) {
371 return toString;
372 }
373 len += snprintf(toString + len, bufferSize - len, "%u", self->bend);
374 return toString;
375#pragma clang diagnostic pop
376}
377
382{
383 size_t temp_length = strlen(str);
384 int length = (temp_length <= INT_MAX) ? ((int)((ssize_t)temp_length)) : -1;
385 if (length < 1 || length > NAO_SONAR_PROTECTED_WALK_COMMAND_DESC_BUFFER_SIZE) {
386 return self;
387 }
389 char* var_str = &var_str_buffer[0];
390 char key_buffer[21];
391 char* key = &key_buffer[0];
392 int bracecount = 0;
393 int startVar = 0;
394 int index = 0;
395 int startKey = 0;
396 int endKey = -1;
397 int varIndex = 0;
398 if (index == 0 && str[0] == '{') {
399 index = 1;
400 }
401 startVar = index;
402 startKey = startVar;
403 do {
404 for (int i = index; i < length; i++) {
405 index = i + 1;
406 if (bracecount == 0 && str[i] == '=') {
407 endKey = i - 1;
408 startVar = index;
409 continue;
410 }
411 if (bracecount == 0 && isspace(str[i])) {
412 startVar = index;
413 if (endKey == -1) {
414 startKey = index;
415 }
416 continue;
417 }
418 if (bracecount == 0 && str[i] == ',') {
419 index = i - 1;
420 break;
421 }
422 if (str[i] == '{') {
423 bracecount++;
424 continue;
425 }
426 if (str[i] == '}') {
427 bracecount--;
428 if (bracecount < 0) {
429 index = i - 1;
430 break;
431 }
432 }
433 if (i == length - 1) {
434 index = i;
435 }
436 }
437 if (endKey >= startKey && endKey - startKey < length) {
438 strncpy(key, str + startKey, ((size_t)(endKey - startKey) + 1));
439 key[(endKey - startKey) + 1] = 0;
440 } else {
441 key[0] = 0;
442 }
443 strncpy(var_str, str + startVar, ((size_t)(index - startVar) + 1));
444 var_str[(index - startVar) + 1] = 0;
445 bracecount = 0;
446 index += 2;
447 startVar = index;
448 startKey = startVar;
449 endKey = -1;
450 if (strlen(key) > 0) {
451 if (0 == strcmp("walkEngineOn", key)) {
452 varIndex = 0;
453 } else if (0 == strcmp("forward", key)) {
454 varIndex = 1;
455 } else if (0 == strcmp("left", key)) {
456 varIndex = 2;
457 } else if (0 == strcmp("turn", key)) {
458 varIndex = 3;
459 } else if (0 == strcmp("priority", key)) {
460 varIndex = 4;
461 } else if (0 == strcmp("exactStepsRequested", key)) {
462 varIndex = 5;
463 } else if (0 == strcmp("speed", key)) {
464 varIndex = 6;
465 } else if (0 == strcmp("isFast", key)) {
466 varIndex = 7;
467 } else if (0 == strcmp("kickWithLeftFoot", key)) {
468 varIndex = 8;
469 } else if (0 == strcmp("useShuffle", key)) {
470 varIndex = 9;
471 } else if (0 == strcmp("leftArmLimp", key)) {
472 varIndex = 10;
473 } else if (0 == strcmp("rightArmLimp", key)) {
474 varIndex = 11;
475 } else if (0 == strcmp("power", key)) {
476 varIndex = 12;
477 } else if (0 == strcmp("odometryResetCounter", key)) {
478 varIndex = 13;
479 } else if (0 == strcmp("bend", key)) {
480 varIndex = 14;
481 } else {
482 varIndex = -1;
483 }
484 }
485 switch (varIndex) {
486 case -1: { break; }
487 case 0:
488 {
489 self->walkEngineOn = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
490 break;
491 }
492 case 1:
493 {
494 self->forward = ((int16_t)atoi(var_str));
495 break;
496 }
497 case 2:
498 {
499 self->left = ((int16_t)atoi(var_str));
500 break;
501 }
502 case 3:
503 {
504 self->turn = ((int8_t)atoi(var_str));
505 break;
506 }
507 case 4:
508 {
509 self->priority = ((int8_t)atoi(var_str));
510 break;
511 }
512 case 5:
513 {
514 self->exactStepsRequested = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
515 break;
516 }
517 case 6:
518 {
519 self->speed = ((uint8_t)atoi(var_str));
520 break;
521 }
522 case 7:
523 {
524 self->isFast = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
525 break;
526 }
527 case 8:
528 {
529 self->kickWithLeftFoot = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
530 break;
531 }
532 case 9:
533 {
534 self->useShuffle = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
535 break;
536 }
537 case 10:
538 {
539 self->leftArmLimp = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
540 break;
541 }
542 case 11:
543 {
544 self->rightArmLimp = strcmp(var_str, "true") == 0 || strcmp(var_str, "1") == 0;
545 break;
546 }
547 case 12:
548 {
549 self->power = ((uint8_t)atoi(var_str));
550 break;
551 }
552 case 13:
553 {
554 self->odometryResetCounter = ((uint8_t)atoi(var_str));
555 break;
556 }
557 case 14:
558 {
559 self->bend = ((uint8_t)atoi(var_str));
560 break;
561 }
562 }
563 if (varIndex >= 0) {
564 varIndex++;
565 }
566 } while(index < length);
567 return self;
568}
569
570/*#ifdef WHITEBOARD_SERIALISATION*/
571
576{
577 uint16_t bit_offset = 0;
578 do {
579 uint16_t byte = bit_offset / 8;
580 uint16_t bit = 7 - (bit_offset % 8);
581 unsigned long newbit = !!(self->walkEngineOn ? 1U : 0U);
582 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
583 bit_offset = bit_offset + 1;
584 } while(false);
585
586 int16_t forward_nbo = htons(self->forward);
587 do {
588 int8_t b;
589 for (b = (16 - 1); b >= 0; b--) {
590 do {
591 uint16_t byte = bit_offset / 8;
592 uint16_t bit = 7 - (bit_offset % 8);
593 unsigned long newbit = !!((forward_nbo >> b) & 1U);
594 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
595 bit_offset = bit_offset + 1;
596 } while(false);
597 }
598 } while(false);
599
600 int16_t left_nbo = htons(self->left);
601 do {
602 int8_t b;
603 for (b = (16 - 1); b >= 0; b--) {
604 do {
605 uint16_t byte = bit_offset / 8;
606 uint16_t bit = 7 - (bit_offset % 8);
607 unsigned long newbit = !!((left_nbo >> b) & 1U);
608 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
609 bit_offset = bit_offset + 1;
610 } while(false);
611 }
612 } while(false);
613
614 int8_t turn_nbo = (self->turn);
615 do {
616 int8_t b;
617 for (b = (8 - 1); b >= 0; b--) {
618 do {
619 uint16_t byte = bit_offset / 8;
620 uint16_t bit = 7 - (bit_offset % 8);
621 unsigned long newbit = !!((turn_nbo >> b) & 1U);
622 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
623 bit_offset = bit_offset + 1;
624 } while(false);
625 }
626 } while(false);
627
628 int8_t priority_nbo = (self->priority);
629 do {
630 int8_t b;
631 for (b = (8 - 1); b >= 0; b--) {
632 do {
633 uint16_t byte = bit_offset / 8;
634 uint16_t bit = 7 - (bit_offset % 8);
635 unsigned long newbit = !!((priority_nbo >> b) & 1U);
636 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
637 bit_offset = bit_offset + 1;
638 } while(false);
639 }
640 } while(false);
641
642 do {
643 uint16_t byte = bit_offset / 8;
644 uint16_t bit = 7 - (bit_offset % 8);
645 unsigned long newbit = !!(self->exactStepsRequested ? 1U : 0U);
646 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
647 bit_offset = bit_offset + 1;
648 } while(false);
649
650 uint8_t speed_nbo = (self->speed);
651 do {
652 int8_t b;
653 for (b = (8 - 1); b >= 0; b--) {
654 do {
655 uint16_t byte = bit_offset / 8;
656 uint16_t bit = 7 - (bit_offset % 8);
657 unsigned long newbit = !!((speed_nbo >> b) & 1U);
658 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
659 bit_offset = bit_offset + 1;
660 } while(false);
661 }
662 } while(false);
663
664 do {
665 uint16_t byte = bit_offset / 8;
666 uint16_t bit = 7 - (bit_offset % 8);
667 unsigned long newbit = !!(self->isFast ? 1U : 0U);
668 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
669 bit_offset = bit_offset + 1;
670 } while(false);
671
672 do {
673 uint16_t byte = bit_offset / 8;
674 uint16_t bit = 7 - (bit_offset % 8);
675 unsigned long newbit = !!(self->kickWithLeftFoot ? 1U : 0U);
676 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
677 bit_offset = bit_offset + 1;
678 } while(false);
679
680 do {
681 uint16_t byte = bit_offset / 8;
682 uint16_t bit = 7 - (bit_offset % 8);
683 unsigned long newbit = !!(self->useShuffle ? 1U : 0U);
684 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
685 bit_offset = bit_offset + 1;
686 } while(false);
687
688 do {
689 uint16_t byte = bit_offset / 8;
690 uint16_t bit = 7 - (bit_offset % 8);
691 unsigned long newbit = !!(self->leftArmLimp ? 1U : 0U);
692 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
693 bit_offset = bit_offset + 1;
694 } while(false);
695
696 do {
697 uint16_t byte = bit_offset / 8;
698 uint16_t bit = 7 - (bit_offset % 8);
699 unsigned long newbit = !!(self->rightArmLimp ? 1U : 0U);
700 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
701 bit_offset = bit_offset + 1;
702 } while(false);
703
704 uint8_t power_nbo = (self->power);
705 do {
706 int8_t b;
707 for (b = (8 - 1); b >= 0; b--) {
708 do {
709 uint16_t byte = bit_offset / 8;
710 uint16_t bit = 7 - (bit_offset % 8);
711 unsigned long newbit = !!((power_nbo >> b) & 1U);
712 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
713 bit_offset = bit_offset + 1;
714 } while(false);
715 }
716 } while(false);
717
718 uint8_t odometryResetCounter_nbo = (self->odometryResetCounter);
719 do {
720 int8_t b;
721 for (b = (8 - 1); b >= 0; b--) {
722 do {
723 uint16_t byte = bit_offset / 8;
724 uint16_t bit = 7 - (bit_offset % 8);
725 unsigned long newbit = !!((odometryResetCounter_nbo >> b) & 1U);
726 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
727 bit_offset = bit_offset + 1;
728 } while(false);
729 }
730 } while(false);
731
732 uint8_t bend_nbo = (self->bend);
733 do {
734 int8_t b;
735 for (b = (8 - 1); b >= 0; b--) {
736 do {
737 uint16_t byte = bit_offset / 8;
738 uint16_t bit = 7 - (bit_offset % 8);
739 unsigned long newbit = !!((bend_nbo >> b) & 1U);
740 dst[byte] ^= (-newbit ^ dst[byte]) & (1UL << bit);
741 bit_offset = bit_offset + 1;
742 } while(false);
743 }
744 } while(false);
745 //avoid unused variable warnings when you try to use an empty gen file or a gen file with no supported serialisation types.
746 (void)self;
747 (void)dst;
748 return bit_offset;
749}
750
755{
756 uint16_t bit_offset = 0;
757 do {
758 uint16_t byte = bit_offset / 8;
759 uint16_t bit = 7 - (bit_offset % 8);
760 char dataByte = src[byte];
761 unsigned char bitValue = (dataByte >> bit) & 1U;
762 dst->walkEngineOn = bitValue != 0;
763 bit_offset = bit_offset + 1;
764 } while(false);
765
766 do {
767 int8_t b;
768 for (b = (16 - 1); b >= 0; b--) {
769 do {
770 uint16_t byte = bit_offset / 8;
771 uint16_t bit = 7 - (bit_offset % 8);
772 char dataByte = src[byte];
773 unsigned char bitValue = (dataByte >> bit) & 1U;
774 dst->forward ^= (-bitValue ^ dst->forward) & (1UL << b);
775 bit_offset = bit_offset + 1;
776 } while(false);
777 }
778 } while(false);
779 dst->forward = ntohs(dst->forward);
780
781 do {
782 int8_t b;
783 for (b = (16 - 1); b >= 0; b--) {
784 do {
785 uint16_t byte = bit_offset / 8;
786 uint16_t bit = 7 - (bit_offset % 8);
787 char dataByte = src[byte];
788 unsigned char bitValue = (dataByte >> bit) & 1U;
789 dst->left ^= (-bitValue ^ dst->left) & (1UL << b);
790 bit_offset = bit_offset + 1;
791 } while(false);
792 }
793 } while(false);
794 dst->left = ntohs(dst->left);
795
796 do {
797 int8_t b;
798 for (b = (8 - 1); b >= 0; b--) {
799 do {
800 uint16_t byte = bit_offset / 8;
801 uint16_t bit = 7 - (bit_offset % 8);
802 char dataByte = src[byte];
803 unsigned char bitValue = (dataByte >> bit) & 1U;
804 dst->turn ^= (-bitValue ^ dst->turn) & (1UL << b);
805 bit_offset = bit_offset + 1;
806 } while(false);
807 }
808 } while(false);
809 dst->turn = (dst->turn);
810
811 do {
812 int8_t b;
813 for (b = (8 - 1); b >= 0; b--) {
814 do {
815 uint16_t byte = bit_offset / 8;
816 uint16_t bit = 7 - (bit_offset % 8);
817 char dataByte = src[byte];
818 unsigned char bitValue = (dataByte >> bit) & 1U;
819 dst->priority ^= (-bitValue ^ dst->priority) & (1UL << b);
820 bit_offset = bit_offset + 1;
821 } while(false);
822 }
823 } while(false);
824 dst->priority = (dst->priority);
825
826 do {
827 uint16_t byte = bit_offset / 8;
828 uint16_t bit = 7 - (bit_offset % 8);
829 char dataByte = src[byte];
830 unsigned char bitValue = (dataByte >> bit) & 1U;
831 dst->exactStepsRequested = bitValue != 0;
832 bit_offset = bit_offset + 1;
833 } while(false);
834
835 do {
836 int8_t b;
837 for (b = (8 - 1); b >= 0; b--) {
838 do {
839 uint16_t byte = bit_offset / 8;
840 uint16_t bit = 7 - (bit_offset % 8);
841 char dataByte = src[byte];
842 unsigned char bitValue = (dataByte >> bit) & 1U;
843 dst->speed ^= (-bitValue ^ dst->speed) & (1UL << b);
844 bit_offset = bit_offset + 1;
845 } while(false);
846 }
847 } while(false);
848 dst->speed = (dst->speed);
849
850 do {
851 uint16_t byte = bit_offset / 8;
852 uint16_t bit = 7 - (bit_offset % 8);
853 char dataByte = src[byte];
854 unsigned char bitValue = (dataByte >> bit) & 1U;
855 dst->isFast = bitValue != 0;
856 bit_offset = bit_offset + 1;
857 } while(false);
858
859 do {
860 uint16_t byte = bit_offset / 8;
861 uint16_t bit = 7 - (bit_offset % 8);
862 char dataByte = src[byte];
863 unsigned char bitValue = (dataByte >> bit) & 1U;
864 dst->kickWithLeftFoot = bitValue != 0;
865 bit_offset = bit_offset + 1;
866 } while(false);
867
868 do {
869 uint16_t byte = bit_offset / 8;
870 uint16_t bit = 7 - (bit_offset % 8);
871 char dataByte = src[byte];
872 unsigned char bitValue = (dataByte >> bit) & 1U;
873 dst->useShuffle = bitValue != 0;
874 bit_offset = bit_offset + 1;
875 } while(false);
876
877 do {
878 uint16_t byte = bit_offset / 8;
879 uint16_t bit = 7 - (bit_offset % 8);
880 char dataByte = src[byte];
881 unsigned char bitValue = (dataByte >> bit) & 1U;
882 dst->leftArmLimp = bitValue != 0;
883 bit_offset = bit_offset + 1;
884 } while(false);
885
886 do {
887 uint16_t byte = bit_offset / 8;
888 uint16_t bit = 7 - (bit_offset % 8);
889 char dataByte = src[byte];
890 unsigned char bitValue = (dataByte >> bit) & 1U;
891 dst->rightArmLimp = bitValue != 0;
892 bit_offset = bit_offset + 1;
893 } while(false);
894
895 do {
896 int8_t b;
897 for (b = (8 - 1); b >= 0; b--) {
898 do {
899 uint16_t byte = bit_offset / 8;
900 uint16_t bit = 7 - (bit_offset % 8);
901 char dataByte = src[byte];
902 unsigned char bitValue = (dataByte >> bit) & 1U;
903 dst->power ^= (-bitValue ^ dst->power) & (1UL << b);
904 bit_offset = bit_offset + 1;
905 } while(false);
906 }
907 } while(false);
908 dst->power = (dst->power);
909
910 do {
911 int8_t b;
912 for (b = (8 - 1); b >= 0; b--) {
913 do {
914 uint16_t byte = bit_offset / 8;
915 uint16_t bit = 7 - (bit_offset % 8);
916 char dataByte = src[byte];
917 unsigned char bitValue = (dataByte >> bit) & 1U;
918 dst->odometryResetCounter ^= (-bitValue ^ dst->odometryResetCounter) & (1UL << b);
919 bit_offset = bit_offset + 1;
920 } while(false);
921 }
922 } while(false);
924
925 do {
926 int8_t b;
927 for (b = (8 - 1); b >= 0; b--) {
928 do {
929 uint16_t byte = bit_offset / 8;
930 uint16_t bit = 7 - (bit_offset % 8);
931 char dataByte = src[byte];
932 unsigned char bitValue = (dataByte >> bit) & 1U;
933 dst->bend ^= (-bitValue ^ dst->bend) & (1UL << b);
934 bit_offset = bit_offset + 1;
935 } while(false);
936 }
937 } while(false);
938 dst->bend = (dst->bend);
939 //avoid unused variable warnings when you try to use an empty gen file or a gen file with no supported serialisation types.
940 (void)src;
941 (void)dst;
942 return bit_offset;
943}
944
945/*#endif // WHITEBOARD_SERIALISATION*/
bool rightArmLimp
lower stiffness in the arms when walking, allows the arm to move a little more.
bool leftArmLimp
lower stiffness in the arms when walking, allows the arm to move a little more.
int8_t priority
subsumption priority 1: unprotected walk, command unmodified.
bool useShuffle
limits the step height so the robot 'shuffles' instead of taking larger steps.
int16_t left
[-200 - 200] step-size(mm) per second, limited to +/- 200mm/step
uint8_t power
[0 - 100] stiffness, auto set to minimum needed values.
bool exactStepsRequested
No ratcheting, no speed 'buildup', just full step sizes.
uint8_t odometryResetCounter
Odometry will reset any time this is changed or incremented.
int16_t forward
[-300 - 300] step-size(mm) per second, limited to +/- 300mm/step
uint8_t bend
[0 - 1] controls what the robot does when stopped, 0 == STAND and lower stiffness,...
int8_t turn
[-85 - 85] step-size(mm) per second, limited to +/- 85deg/step
uint8_t speed
[0 - 100] modifier for forward etc.
size_t wb_nao_sonar_protected_walk_command_from_network_serialised(const char *src, struct wb_nao_sonar_protected_walk_command *dst)
Convert from a compressed, serialised, network byte order byte stream.
struct wb_nao_sonar_protected_walk_command * wb_nao_sonar_protected_walk_command_from_string(struct wb_nao_sonar_protected_walk_command *self, const char *str)
Convert from a string.
const char * wb_nao_sonar_protected_walk_command_to_string(const struct wb_nao_sonar_protected_walk_command *self, char *toString, size_t bufferSize)
Convert to a string.
size_t wb_nao_sonar_protected_walk_command_to_network_serialised(const struct wb_nao_sonar_protected_walk_command *self, char *dst)
Convert to a compressed, serialised, network byte order byte stream.
const char * wb_nao_sonar_protected_walk_command_description(const struct wb_nao_sonar_protected_walk_command *self, char *descString, size_t bufferSize)
Convert to a description string.
#define NAO_SONAR_PROTECTED_WALK_COMMAND_DESC_BUFFER_SIZE