xref: /rk3399_ARM-atf/plat/socionext/uniphier/uniphier_console.S (revision ac9f1b555519ec77829f95d2e227c5d51afbd37b)
1d8e919c7SMasahiro Yamada/*
2*ac9f1b55SMasahiro Yamada * Copyright (c) 2017-2019, ARM Limited and Contributors. All rights reserved.
3d8e919c7SMasahiro Yamada *
4d8e919c7SMasahiro Yamada * SPDX-License-Identifier: BSD-3-Clause
5d8e919c7SMasahiro Yamada */
6d8e919c7SMasahiro Yamada
7d8e919c7SMasahiro Yamada#include <asm_macros.S>
8*ac9f1b55SMasahiro Yamada#include <drivers/console.h>
9d8e919c7SMasahiro Yamada
10*ac9f1b55SMasahiro Yamada#include "uniphier_console.h"
11d8e919c7SMasahiro Yamada
12d8e919c7SMasahiro Yamada/*
13d8e919c7SMasahiro Yamada * In: w0 - character to be printed
14*ac9f1b55SMasahiro Yamada *     x1 - pointer to console structure
15*ac9f1b55SMasahiro Yamada * Out: return the character written (always succeeds)
16d8e919c7SMasahiro Yamada * Clobber: x2
17d8e919c7SMasahiro Yamada */
18*ac9f1b55SMasahiro Yamada	.globl	uniphier_console_putc
19*ac9f1b55SMasahiro Yamadafunc uniphier_console_putc
20*ac9f1b55SMasahiro Yamada	ldr	x1, [x1, #CONSOLE_T_DRVDATA]
21d8e919c7SMasahiro Yamada
22d8e919c7SMasahiro Yamada	/* Wait until the transmitter FIFO gets empty */
23d8e919c7SMasahiro Yamada0:	ldr	w2, [x1, #UNIPHIER_UART_LSR]
24d8e919c7SMasahiro Yamada	tbz	w2, #UNIPHIER_UART_LSR_THRE_BIT, 0b
25d8e919c7SMasahiro Yamada
26d8e919c7SMasahiro Yamada	mov	w2, w0
27d8e919c7SMasahiro Yamada
28d8e919c7SMasahiro Yamada1:	str	w2, [x1, #UNIPHIER_UART_TX]
29d8e919c7SMasahiro Yamada
30d8e919c7SMasahiro Yamada	cmp	w2, #'\n'
31*ac9f1b55SMasahiro Yamada	b.ne	2f
32d8e919c7SMasahiro Yamada	mov	w2, #'\r'	/* Append '\r' to '\n' */
33d8e919c7SMasahiro Yamada	b	1b
34*ac9f1b55SMasahiro Yamada2:	ret
35*ac9f1b55SMasahiro Yamadaendfunc uniphier_console_putc
36d8e919c7SMasahiro Yamada
37d8e919c7SMasahiro Yamada/*
38*ac9f1b55SMasahiro Yamada * In: x0 - pointer to console structure
39*ac9f1b55SMasahiro Yamada * Out: return the character read, or ERROR_NO_PENDING_CHAR if no character
40*ac9f1b55SMasahiro Yamada	is available
41d8e919c7SMasahiro Yamada * Clobber: x1
42d8e919c7SMasahiro Yamada */
43*ac9f1b55SMasahiro Yamada	.globl	uniphier_console_getc
44*ac9f1b55SMasahiro Yamadafunc uniphier_console_getc
45*ac9f1b55SMasahiro Yamada	ldr	x0, [x0, #CONSOLE_T_DRVDATA]
46d8e919c7SMasahiro Yamada
47*ac9f1b55SMasahiro Yamada	ldr	w1, [x0, #UNIPHIER_UART_LSR]
48*ac9f1b55SMasahiro Yamada	tbz	w1, #UNIPHIER_UART_LSR_DR_BIT, 0f
49d8e919c7SMasahiro Yamada
50d8e919c7SMasahiro Yamada	ldr	w0, [x0, #UNIPHIER_UART_RX]
51*ac9f1b55SMasahiro Yamada	ret
52d8e919c7SMasahiro Yamada
53*ac9f1b55SMasahiro Yamada0:	mov	w0, #ERROR_NO_PENDING_CHAR
54d8e919c7SMasahiro Yamada	ret
55*ac9f1b55SMasahiro Yamadaendfunc uniphier_console_getc
56d8e919c7SMasahiro Yamada
57d8e919c7SMasahiro Yamada/*
58*ac9f1b55SMasahiro Yamada * In: x0 - pointer to console structure
59*ac9f1b55SMasahiro Yamada * Out: return 0 (always succeeds)
60d8e919c7SMasahiro Yamada * Clobber: x1
61d8e919c7SMasahiro Yamada */
62*ac9f1b55SMasahiro Yamada	.global uniphier_console_flush
63*ac9f1b55SMasahiro Yamadafunc uniphier_console_flush
64*ac9f1b55SMasahiro Yamada	ldr	x0, [x0, #CONSOLE_T_DRVDATA]
65d8e919c7SMasahiro Yamada
66d8e919c7SMasahiro Yamada	/* wait until the transmitter gets empty */
67d8e919c7SMasahiro Yamada0:	ldr	w1, [x0, #UNIPHIER_UART_LSR]
68d8e919c7SMasahiro Yamada	tbz	w1, #UNIPHIER_UART_LSR_TEMT_BIT, 0b
69d8e919c7SMasahiro Yamada
70d8e919c7SMasahiro Yamada	mov	w0, #0
71d8e919c7SMasahiro Yamada	ret
72*ac9f1b55SMasahiro Yamadaendfunc uniphier_console_flush
73