mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-18 02:24:18 +00:00
831b0e9824
And from crash_console_flush. We ignore the error information return by console_flush in _every_ place where we call it, and casting the return type to void does not work around the MISRA violation that this causes. Instead, we collect the error information from the driver (to avoid changing that API), and don't return it to the caller. Change-Id: I1e35afe01764d5c8f0efd04f8949d333ffb688c1 Signed-off-by: Jimmy Brisson <jimmy.brisson@arm.com>
92 lines
2.2 KiB
C
92 lines
2.2 KiB
C
/*
|
|
* Copyright (c) 2019-2020, Socionext Inc. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <assert.h>
|
|
|
|
#include <drivers/console.h>
|
|
#include <errno.h>
|
|
#include <lib/mmio.h>
|
|
#include <plat/common/platform.h>
|
|
|
|
#include "uniphier.h"
|
|
#include "uniphier_console.h"
|
|
|
|
#define UNIPHIER_UART_OFFSET 0x100
|
|
#define UNIPHIER_UART_NR_PORTS 4
|
|
|
|
/* These callbacks are implemented in assembly to use crash_console_helpers.S */
|
|
int uniphier_console_putc(int character, struct console *console);
|
|
int uniphier_console_getc(struct console *console);
|
|
void uniphier_console_flush(struct console *console);
|
|
|
|
static console_t uniphier_console = {
|
|
.flags = CONSOLE_FLAG_BOOT |
|
|
#if DEBUG
|
|
CONSOLE_FLAG_RUNTIME |
|
|
#endif
|
|
CONSOLE_FLAG_CRASH |
|
|
CONSOLE_FLAG_TRANSLATE_CRLF,
|
|
.putc = uniphier_console_putc,
|
|
.getc = uniphier_console_getc,
|
|
.flush = uniphier_console_flush,
|
|
};
|
|
|
|
static const uintptr_t uniphier_uart_base[] = {
|
|
[UNIPHIER_SOC_LD11] = 0x54006800,
|
|
[UNIPHIER_SOC_LD20] = 0x54006800,
|
|
[UNIPHIER_SOC_PXS3] = 0x54006800,
|
|
};
|
|
|
|
/*
|
|
* There are 4 UART ports available on this platform. By default, we want to
|
|
* use the same one as used in the previous firmware stage.
|
|
*/
|
|
static uintptr_t uniphier_console_get_base(unsigned int soc)
|
|
{
|
|
uintptr_t base, end;
|
|
uint32_t div;
|
|
|
|
assert(soc < ARRAY_SIZE(uniphier_uart_base));
|
|
base = uniphier_uart_base[soc];
|
|
end = base + UNIPHIER_UART_OFFSET * UNIPHIER_UART_NR_PORTS;
|
|
|
|
while (base < end) {
|
|
div = mmio_read_32(base + UNIPHIER_UART_DLR);
|
|
if (div)
|
|
return base;
|
|
base += UNIPHIER_UART_OFFSET;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void uniphier_console_init(uintptr_t base)
|
|
{
|
|
mmio_write_32(base + UNIPHIER_UART_FCR, UNIPHIER_UART_FCR_ENABLE_FIFO);
|
|
mmio_write_32(base + UNIPHIER_UART_LCR_MCR,
|
|
UNIPHIER_UART_LCR_WLEN8 << 8);
|
|
}
|
|
|
|
void uniphier_console_setup(unsigned int soc)
|
|
{
|
|
uintptr_t base;
|
|
|
|
base = uniphier_console_get_base(soc);
|
|
if (!base)
|
|
plat_error_handler(-EINVAL);
|
|
|
|
uniphier_console.base = base;
|
|
console_register(&uniphier_console);
|
|
|
|
/*
|
|
* The hardware might be still printing characters queued up in the
|
|
* previous firmware stage. Make sure the transmitter is empty before
|
|
* any initialization. Otherwise, the console might get corrupted.
|
|
*/
|
|
console_flush();
|
|
|
|
uniphier_console_init(base);
|
|
}
|