imxrt: implement uart ioctl to set baudrate

JIRA: RTOS-848
phoenix-rtos · Jun 25, 2024 · 7789882 · 7789882
1 parent 7ff36b5
commit 7789882
Show file tree

Hide file tree

Showing 3 changed files with 66 additions and 0 deletions.
diff --git a/devices/devs.h b/devices/devs.h
@@ -30,6 +30,8 @@
 
 #define DEVS_ITER_STOP ((const dev_t *)-1)
 
+#define DEV_CONTROL_SETBAUD 1
+
 /* clang-format off */
 enum { dev_isMappable = 0, dev_isNotMappable };
 /* clang-format on */

diff --git a/devices/uart-imxrt106x/uart.c b/devices/uart-imxrt106x/uart.c
@@ -624,6 +624,37 @@ static int uart_init(unsigned int minor)
 }
 
 
+static int uart_control(unsigned int minor, int cmd, void *args)
+{
+	u32 reg;
+	uart_t *uart;
+
+	uart = uart_getInstance(minor);
+	if (uart == NULL) {
+		return -EINVAL;
+	}
+
+	switch (cmd) {
+		case DEV_CONTROL_SETBAUD:
+			/* Set baudrate */
+			reg = *(uart->base + baudr) & ~((0x1f << 24) | (1 << 17) | 0x1fff);
+			*(uart->base + baudr) = reg | calculate_baudrate(*(int *)args);
+
+			/* Set 8 bit and no parity mode */
+			*(uart->base + ctrlr) &= ~0x117;
+
+			/* One stop bit */
+			*(uart->base + baudr) &= ~(1 << 13);
+			return EOK;
+
+		default:
+			break;
+	}
+
+	return -ENOSYS;
+}
+
+
 __attribute__((constructor)) static void uart_reg(void)
 {
 	static const dev_ops_t opsUartIMXRT106X = {
@@ -632,6 +663,7 @@ __attribute__((constructor)) static void uart_reg(void)
 		.erase = NULL,
 		.sync = uart_sync,
 		.map = uart_map,
+		.control = uart_control,
 	};
 
 	static const dev_t devUartIMXRT106X = {

diff --git a/devices/uart-imxrt117x/uart.c b/devices/uart-imxrt117x/uart.c
@@ -655,6 +655,37 @@ static int uart_init(unsigned int minor)
 }
 
 
+static int uart_control(unsigned int minor, int cmd, void *args)
+{
+	u32 reg;
+	uart_t *uart;
+
+	uart = uart_getInstance(minor);
+	if (uart == NULL) {
+		return -EINVAL;
+	}
+
+	switch (cmd) {
+		case DEV_CONTROL_SETBAUD:
+			/* Set baudrate */
+			reg = *(uart->base + baudr) & ~((0x1f << 24) | (1 << 17) | 0xfff);
+			*(uart->base + baudr) = reg | calculate_baudrate(*(int *)args);
+
+			/* Set 8 bit and no parity mode */
+			*(uart->base + ctrlr) &= ~0x117;
+
+			/* One stop bit */
+			*(uart->base + baudr) &= ~(1 << 13);
+			return EOK;
+
+		default:
+			break;
+	}
+
+	return -ENOSYS;
+}
+
+
 __attribute__((constructor)) static void uart_reg(void)
 {
 	static const dev_ops_t opsUartIMXRT117X = {
@@ -663,6 +694,7 @@ __attribute__((constructor)) static void uart_reg(void)
 		.erase = NULL,
 		.sync = uart_sync,
 		.map = uart_map,
+		.control = uart_control,
 	};
 
 	static const dev_t devUartIMXRT117X = {