diff options
| author | lonkaars <loek@pipeframe.xyz> | 2022-05-29 16:27:29 +0200 |
|---|---|---|
| committer | lonkaars <loek@pipeframe.xyz> | 2022-05-29 16:27:29 +0200 |
| commit | 3b2c2cf6b2af9e76b343a5a8fc8e9245f240690d (patch) | |
| tree | f257a9a03b8205f55301901d00c5865f8b179607 /shared/serial_parse.c | |
| parent | f466856892d94f5b42bf2369cae0fd73dd468dfa (diff) | |
serial parsing working on client
Diffstat (limited to 'shared/serial_parse.c')
| -rw-r--r-- | shared/serial_parse.c | 21 |
1 files changed, 21 insertions, 0 deletions
diff --git a/shared/serial_parse.c b/shared/serial_parse.c index b1b4f50..49f4cbf 100644 --- a/shared/serial_parse.c +++ b/shared/serial_parse.c @@ -2,6 +2,10 @@ #include "consts.h" #include "serial_parse.h" +#include "errcatch.h" +#ifdef W2_SIM +#include "../robot/orangutan_shim.h" +#endif bool w2_serial_parse(uint8_t byte) { static uint8_t current_message[W2_SERIAL_READ_BUFFER_SIZE] = {0}; @@ -38,3 +42,20 @@ bool w2_serial_parse(uint8_t byte) { return W2_SERIAL_READ_SUCCESS; } + +void w2_cmd_handler(uint8_t data[W2_SERIAL_READ_BUFFER_SIZE], uint8_t data_length) { + w2_s_bin *copy = w2_bin_s_alloc(data_length, data); + void (*handler)(w2_s_bin *) = g_w2_cmd_handlers[data[0]]; + + if (handler == NULL) { + w2_errcatch_throw(W2_E_WARN_SERIAL_NOISY); + } else { +#ifdef W2_SIM + w2_sim_print_serial(copy); +#endif + handler(copy); + } + + free(copy); +} + |