serial.c 2.48 KB
Newer Older
Rahix's avatar
Rahix committed
1
2
3
#include <stdint.h>
#include <stdio.h>

Rahix's avatar
Rahix committed
4
#include "max32665.h"
Rahix's avatar
Rahix committed
5
6
#include "cdcacm.h"
#include "uart.h"
7
#include "tmr_utils.h"
Rahix's avatar
Rahix committed
8
9
10
11
12

#include "FreeRTOS.h"
#include "task.h"
#include "queue.h"

13
#include "modules.h"
14
#include "modules/log.h"
15

Rahix's avatar
Rahix committed
16
/* Task ID for the serial handler */
Rahix's avatar
Rahix committed
17
TaskHandle_t serial_task_id = NULL;
Rahix's avatar
Rahix committed
18

Rahix's avatar
Rahix committed
19
/* The serial console in use (UART0) */
Rahix's avatar
Rahix committed
20
extern mxc_uart_regs_t *ConsoleUart;
Rahix's avatar
Rahix committed
21
/* Read queue, filled by both UART and CDCACM */
Rahix's avatar
Rahix committed
22
23
static QueueHandle_t read_queue;

Rahix's avatar
Rahix committed
24
25
26
/*
 * API-call to write a string.  Output goes to both CDCACM and UART
 */
Rahix's avatar
Rahix committed
27
void epic_uart_write_str(char *str, intptr_t length)
Rahix's avatar
Rahix committed
28
{
Rahix's avatar
Rahix committed
29
30
	UART_Write(ConsoleUart, (uint8_t *)str, length);
	cdcacm_write((uint8_t *)str, length);
Rahix's avatar
Rahix committed
31
32
}

Rahix's avatar
Rahix committed
33
34
35
/*
 * Blocking API-call to read a character from the queue.
 */
Rahix's avatar
Rahix committed
36
37
38
39
40
41
42
char epic_uart_read_chr(void)
{
	char chr;
	xQueueReceive(read_queue, &chr, portMAX_DELAY);
	return chr;
}

Rahix's avatar
Rahix committed
43
44
45
46
47
48
/* Interrupt handler needed for SDK UART implementation */
void UART0_IRQHandler(void)
{
	UART_Handler(ConsoleUart);
}

Rahix's avatar
Rahix committed
49
static void uart_callback(uart_req_t *req, int error)
Rahix's avatar
Rahix committed
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
{
	BaseType_t xHigherPriorityTaskWoken = pdFALSE;
	vTaskNotifyGiveFromISR(serial_task_id, &xHigherPriorityTaskWoken);
	portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
}

static void enqueue_char(char chr)
{
	if (chr == 0x3) {
		/* Control-C */
		TMR_TO_Start(MXC_TMR5, 1, 0);
	}

	if (xQueueSend(read_queue, &chr, 100) == errQUEUE_FULL) {
		/* Queue overran, wait a bit */
		vTaskDelay(portTICK_PERIOD_MS * 50);
	}
}

Rahix's avatar
Rahix committed
69
void vSerialTask(void *pvParameters)
Rahix's avatar
Rahix committed
70
71
72
73
{
	static uint8_t buffer[sizeof(char) * SERIAL_READ_BUFFER_SIZE];
	static StaticQueue_t read_queue_data;

Rahix's avatar
Rahix committed
74
75
	serial_task_id = xTaskGetCurrentTaskHandle();

Rahix's avatar
Rahix committed
76
77
	/* Setup read queue */
	read_queue = xQueueCreateStatic(
Rahix's avatar
Rahix committed
78
		SERIAL_READ_BUFFER_SIZE, sizeof(char), buffer, &read_queue_data
Rahix's avatar
Rahix committed
79
80
81
82
83
	);

	/* Setup UART interrupt */
	NVIC_ClearPendingIRQ(UART0_IRQn);
	NVIC_DisableIRQ(UART0_IRQn);
Rahix's avatar
Rahix committed
84
	NVIC_SetPriority(UART0_IRQn, 6);
Rahix's avatar
Rahix committed
85
86
	NVIC_EnableIRQ(UART0_IRQn);

Rahix's avatar
Rahix committed
87
88
89
90
91
92
	unsigned char data;
	uart_req_t read_req = {
		.data     = &data,
		.len      = 1,
		.callback = uart_callback,
	};
Rahix's avatar
Rahix committed
93

Rahix's avatar
Rahix committed
94
95
96
	while (1) {
		int ret = UART_ReadAsync(ConsoleUart, &read_req);
		if (ret != E_NO_ERROR && ret != E_BUSY) {
97
			LOG_ERR("serial", "error reading uart: %d", ret);
Rahix's avatar
Rahix committed
98
			vTaskDelay(portMAX_DELAY);
Rahix's avatar
Rahix committed
99
100
		}

Rahix's avatar
Rahix committed
101
102
103
104
		ulTaskNotifyTake(pdTRUE, portTICK_PERIOD_MS * 1000);

		if (read_req.num > 0) {
			enqueue_char(*read_req.data);
105
106
		}

Rahix's avatar
Rahix committed
107
108
		while (UART_NumReadAvail(ConsoleUart) > 0) {
			enqueue_char(UART_ReadByte(ConsoleUart));
Rahix's avatar
Rahix committed
109
		}
Rahix's avatar
Rahix committed
110
111
112
113

		while (cdcacm_num_read_avail() > 0) {
			enqueue_char(cdcacm_read());
		}
Rahix's avatar
Rahix committed
114
115
	}
}