serial.c 3.54 KB
Newer Older
1
2
3
4
#include "epicardium.h"
#include "api/interrupt-sender.h"
#include "modules/log.h"
#include "modules/modules.h"
Rahix's avatar
Rahix committed
5

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

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

14
15
#include <stdint.h>
#include <stdio.h>
16

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

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

Rahix's avatar
Rahix committed
25
26
27
/*
 * API-call to write a string.  Output goes to both CDCACM and UART
 */
28
void epic_uart_write_str(const char *str, intptr_t length)
Rahix's avatar
Rahix committed
29
{
30
31
32
33
34
35
36
	uint32_t basepri = __get_BASEPRI();
	if (xPortIsInsideInterrupt()) {
		taskENTER_CRITICAL_FROM_ISR();
	} else {
		taskENTER_CRITICAL();
	}

Rahix's avatar
Rahix committed
37
	UART_Write(ConsoleUart, (uint8_t *)str, length);
38
39
40
41
42
43
44

	if (xPortIsInsideInterrupt()) {
		taskEXIT_CRITICAL_FROM_ISR(basepri);
	} else {
		taskEXIT_CRITICAL();
	}

Rahix's avatar
Rahix committed
45
	cdcacm_write((uint8_t *)str, length);
46
	ble_uart_write((uint8_t *)str, length);
Rahix's avatar
Rahix committed
47
48
}

Rahix's avatar
Rahix committed
49
/*
50
 * API-call to read a character from the queue.
Rahix's avatar
Rahix committed
51
 */
52
int epic_uart_read_char(void)
Rahix's avatar
Rahix committed
53
54
{
	char chr;
55
56
57
58
	if (xQueueReceive(read_queue, &chr, 0) == pdTRUE) {
		return (int)chr;
	}
	return (-1);
Rahix's avatar
Rahix committed
59
60
}

61
62
63
64
65
/*
 * API-call to read data from the queue.
 */
int epic_uart_read_str(char *buf, size_t cnt)
{
66
	size_t i = 0;
67
68
69
70
71
72
73
74
75
76

	for (i = 0; i < cnt; i++) {
		if (xQueueReceive(read_queue, &buf[i], 0) != pdTRUE) {
			break;
		}
	}

	return i;
}

77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
long _write_epicardium(int fd, const char *buf, size_t cnt)
{
	/*
	 * Only print one line at a time.  Insert `\r` between lines so they are
	 * properly displayed on the serial console.
	 */
	size_t i, last = 0;
	for (i = 0; i < cnt; i++) {
		if (buf[i] == '\n') {
			epic_uart_write_str(&buf[last], i - last);
			epic_uart_write_str("\r", 1);
			last = i;
		}
	}
	epic_uart_write_str(&buf[last], cnt - last);
	return cnt;
}

Rahix's avatar
Rahix committed
95
96
97
98
99
100
/* Interrupt handler needed for SDK UART implementation */
void UART0_IRQHandler(void)
{
	UART_Handler(ConsoleUart);
}

Rahix's avatar
Rahix committed
101
static void uart_callback(uart_req_t *req, int error)
Rahix's avatar
Rahix committed
102
103
104
105
106
107
{
	BaseType_t xHigherPriorityTaskWoken = pdFALSE;
	vTaskNotifyGiveFromISR(serial_task_id, &xHigherPriorityTaskWoken);
	portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
}

108
void serial_enqueue_char(char chr)
Rahix's avatar
Rahix committed
109
110
111
{
	if (chr == 0x3) {
		/* Control-C */
112
		api_interrupt_trigger(EPIC_INT_CTRL_C);
113
114
	}

Rahix's avatar
Rahix committed
115
116
117
118
	if (xQueueSend(read_queue, &chr, 100) == errQUEUE_FULL) {
		/* Queue overran, wait a bit */
		vTaskDelay(portTICK_PERIOD_MS * 50);
	}
119
120

	api_interrupt_trigger(EPIC_INT_UART_RX);
Rahix's avatar
Rahix committed
121
122
}

Rahix's avatar
Rahix committed
123
void vSerialTask(void *pvParameters)
Rahix's avatar
Rahix committed
124
125
126
127
{
	static uint8_t buffer[sizeof(char) * SERIAL_READ_BUFFER_SIZE];
	static StaticQueue_t read_queue_data;

Rahix's avatar
Rahix committed
128
129
	serial_task_id = xTaskGetCurrentTaskHandle();

Rahix's avatar
Rahix committed
130
131
	/* Setup read queue */
	read_queue = xQueueCreateStatic(
Rahix's avatar
Rahix committed
132
		SERIAL_READ_BUFFER_SIZE, sizeof(char), buffer, &read_queue_data
Rahix's avatar
Rahix committed
133
134
135
136
137
	);

	/* Setup UART interrupt */
	NVIC_ClearPendingIRQ(UART0_IRQn);
	NVIC_DisableIRQ(UART0_IRQn);
Rahix's avatar
Rahix committed
138
	NVIC_SetPriority(UART0_IRQn, 6);
Rahix's avatar
Rahix committed
139
140
	NVIC_EnableIRQ(UART0_IRQn);

Rahix's avatar
Rahix committed
141
142
143
144
145
146
	unsigned char data;
	uart_req_t read_req = {
		.data     = &data,
		.len      = 1,
		.callback = uart_callback,
	};
Rahix's avatar
Rahix committed
147

Rahix's avatar
Rahix committed
148
149
150
	while (1) {
		int ret = UART_ReadAsync(ConsoleUart, &read_req);
		if (ret != E_NO_ERROR && ret != E_BUSY) {
151
			LOG_ERR("serial", "error reading uart: %d", ret);
Rahix's avatar
Rahix committed
152
			vTaskDelay(portMAX_DELAY);
Rahix's avatar
Rahix committed
153
154
		}

Rahix's avatar
Rahix committed
155
156
157
		ulTaskNotifyTake(pdTRUE, portTICK_PERIOD_MS * 1000);

		if (read_req.num > 0) {
158
			serial_enqueue_char(*read_req.data);
159
160
		}

Rahix's avatar
Rahix committed
161
		while (UART_NumReadAvail(ConsoleUart) > 0) {
162
			serial_enqueue_char(UART_ReadByte(ConsoleUart));
Rahix's avatar
Rahix committed
163
		}
Rahix's avatar
Rahix committed
164
165

		while (cdcacm_num_read_avail() > 0) {
166
			serial_enqueue_char(cdcacm_read());
Rahix's avatar
Rahix committed
167
		}
Rahix's avatar
Rahix committed
168
169
	}
}