Motor-Controller/shared/drivers/p_serial_mgr.c

#include "p_serial_mgr.h"
#include "putil.h"
#include "stm32l4xx_hal_uart.h"

#define NUM_BUFFERS (10)

uint8_t sbuffer[NUM_BUFFERS][MAX_MESSAGE_LEN];
uint8_t active_buffer = 0;

uint8_t rxb[MAX_MESSAGE_LEN];
// this protocol is very similar to the digi api v2 (inspired from)
// [0]{1} Start delimiter 0x7E
// [1]{1} Source Address
// [2]{1} Destination Address
// [3]{1} Length Byte (of non-delimited framebuffer)
// [4-n]{n} frame data
// [n+1]{1} checksum
// Escape bytes are 0x7D, only frame data can be escaped
// Escaped bytes are followed by the byte to be escaped XOR'd with 0x20
// 0x7D and 0x7E need to be escaped (within the frame data)

typedef enum serial_state_t
{
	SS_IDLE = 0,  // waiting
	SS_START = 1, // get start byte, interrupt after 4 more bytes
} serial_state_t;

static UART_HandleTypeDef *_serial_huart_inst = NULL;

static uint8_t rxc = '\0';
static serial_state_t sstate = SS_IDLE;

void UART1_RxCpltCallback(UART_HandleTypeDef *huart)
{
	if (sstate == SS_IDLE && sbuffer[active_buffer][0] == 0x7E)
	{
		sstate = SS_START;
	}
	else
	{
		HAL_UART_Receive_IT(_serial_huart_inst, sbuffer[active_buffer], 1);
	}
}

void p_serial_mgr_init(UART_HandleTypeDef *huart)
{
	_serial_huart_inst = huart;
	_serial_huart_inst->RxCpltCallback = UART1_RxCpltCallback;
}
void p_serial_mgr_service(void)
{
	if (sstate == SS_START)
	{
		HAL_UART_Receive(_serial_huart_inst, &sbuffer[active_buffer][1], MAX_MESSAGE_LEN, 10);
		for (int ind = 0; ind < 24; ind++)
		{
			PDEBUG("[%d]: 0x%02x\n", ind, sbuffer[active_buffer][ind]);
		}
		PDEBUG("\n\n");
		sstate = SS_IDLE;
		active_buffer = (active_buffer + 1) % NUM_BUFFERS;
		HAL_UART_Receive_IT(_serial_huart_inst, sbuffer[active_buffer], 1);
	}
}

void p_serial_mgr_start()
{
	sstate = SS_IDLE;
	HAL_UART_Receive_IT(_serial_huart_inst, sbuffer[active_buffer], 1);
}