firmware/src/data_link.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24

#include <zephyr/drivers/uart.h>

#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);
}