From ff3fa235236f2d6d92f7869fb4f55e3655b0502a Mon Sep 17 00:00:00 2001 From: xengineering Date: Fri, 31 May 2024 10:33:56 +0200 Subject: firmware: Separate data link related code --- firmware/CMakeLists.txt | 1 + firmware/src/data_link.c | 24 ++++++++++++++++++++++++ firmware/src/data_link.h | 10 ++++++++++ firmware/src/main.c | 32 ++++---------------------------- 4 files changed, 39 insertions(+), 28 deletions(-) create mode 100644 firmware/src/data_link.c create mode 100644 firmware/src/data_link.h diff --git a/firmware/CMakeLists.txt b/firmware/CMakeLists.txt index 8af1e4a..0a18295 100644 --- a/firmware/CMakeLists.txt +++ b/firmware/CMakeLists.txt @@ -4,4 +4,5 @@ project(iot-core) target_sources(app PRIVATE src/main.c + src/data_link.c src/eui64.c) diff --git a/firmware/src/data_link.c b/firmware/src/data_link.c new file mode 100644 index 0000000..a6d091a --- /dev/null +++ b/firmware/src/data_link.c @@ -0,0 +1,24 @@ +#include + +#include "data_link.h" + +void dl_send_frame(const struct device *const uart_dev, uint8_t *buffer, + size_t len) { + for (size_t i = 0; i < len; i++) { + uint8_t octet = *(buffer + i); + switch (octet) { + case DL_SLIP_END: + uart_poll_out(uart_dev, DL_SLIP_ESC); + uart_poll_out(uart_dev, DL_SLIP_ESC_END); + break; + case DL_SLIP_ESC: + uart_poll_out(uart_dev, DL_SLIP_ESC); + uart_poll_out(uart_dev, DL_SLIP_ESC_ESC); + break; + default: + uart_poll_out(uart_dev, octet); + break; + } + } + uart_poll_out(uart_dev, DL_SLIP_END); +} diff --git a/firmware/src/data_link.h b/firmware/src/data_link.h new file mode 100644 index 0000000..359cb2b --- /dev/null +++ b/firmware/src/data_link.h @@ -0,0 +1,10 @@ +#include +#include + +#define DL_SLIP_END 0xC0 +#define DL_SLIP_ESC 0xDB +#define DL_SLIP_ESC_END 0xDC +#define DL_SLIP_ESC_ESC 0xDD + +void dl_send_frame(const struct device *const uart_dev, uint8_t *buffer, + size_t len); diff --git a/firmware/src/main.c b/firmware/src/main.c index dedd603..18e4564 100644 --- a/firmware/src/main.c +++ b/firmware/src/main.c @@ -1,39 +1,15 @@ #include -#include #include #include #include #include +#include "data_link.h" + #define UART_DEVICE_NODE DT_CHOSEN(zephyr_shell_uart) static const struct device *const uart_dev = DEVICE_DT_GET(UART_DEVICE_NODE); -#define SLIP_END 0xC0 -#define SLIP_ESC 0xDB -#define SLIP_ESC_END 0xDC -#define SLIP_ESC_ESC 0xDD - -void send_frame(uint8_t *buffer, size_t len) { - for (size_t i = 0; i < len; i++) { - uint8_t octet = *(buffer + i); - switch (octet) { - case SLIP_END: - uart_poll_out(uart_dev, SLIP_ESC); - uart_poll_out(uart_dev, SLIP_ESC_END); - break; - case SLIP_ESC: - uart_poll_out(uart_dev, SLIP_ESC); - uart_poll_out(uart_dev, SLIP_ESC_ESC); - break; - default: - uart_poll_out(uart_dev, octet); - break; - } - } - uart_poll_out(uart_dev, SLIP_END); -} - int main(void) { if (!device_is_ready(uart_dev)) { @@ -41,11 +17,11 @@ int main(void) return 0; } - uint8_t frame[] = {0xDE, SLIP_END, SLIP_ESC, 0xAD}; + uint8_t frame[] = {0xDE, DL_SLIP_END, DL_SLIP_ESC, 0xAD}; while (true) { k_sleep(K_MSEC(1000)); - send_frame(frame, ARRAY_SIZE(frame)); + dl_send_frame(uart_dev, frame, ARRAY_SIZE(frame)); } return 0; -- cgit v1.2.3-70-g09d2