43fa7ce53f
Refactors all of the console drivers to use a shared driver class initialization priority configuration, CONFIG_CONSOLE_INIT_PRIORITY, to allow configuring console drivers separately from other devices. This is similar to other driver classes like I2C and SPI. The default is set to CONFIG_KERNEL_INIT_PRIORITY_DEFAULT to preserve the existing default initialization priority for most drivers. The driver-specific option, CONFIG_NATIVE_POSIX_CONSOLE_INIT_PRIORITY, is left intact because the native posix console driver needs to initialize after the UART console driver when both drivers are enabled. Signed-off-by: Maureen Helm <maureen.helm@intel.com>
81 lines
1.8 KiB
C
81 lines
1.8 KiB
C
/*
|
|
* Copyright (c) 2016 Cadence Design Systems, Inc.
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <xtensa/simcall.h>
|
|
#include <device.h>
|
|
#include <init.h>
|
|
|
|
#if defined(CONFIG_PRINTK) || defined(CONFIG_STDOUT_CONSOLE)
|
|
/**
|
|
* @brief Output one character to SIMULATOR console
|
|
* @param c Character to output
|
|
* @return The character passed as input.
|
|
*/
|
|
static int console_out(int c)
|
|
{
|
|
char buf[16];
|
|
|
|
register int a2 __asm__ ("a2") = SYS_write;
|
|
register int a3 __asm__ ("a3") = 1;
|
|
register char *a4 __asm__ ("a4") = buf;
|
|
register int a5 __asm__ ("a5") = 1;
|
|
register int ret_val __asm__ ("a2");
|
|
register int ret_err __asm__ ("a3");
|
|
|
|
buf[0] = (char)c;
|
|
__asm__ volatile ("simcall"
|
|
: "=a" (ret_val), "=a" (ret_err)
|
|
: "a" (a2), "a" (a3), "a" (a4), "a" (a5)
|
|
: "memory");
|
|
return c;
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_STDOUT_CONSOLE)
|
|
extern void __stdout_hook_install(int (*hook)(int));
|
|
#else
|
|
#define __stdout_hook_install(x) \
|
|
do {/* nothing */ \
|
|
} while ((0))
|
|
#endif
|
|
|
|
#if defined(CONFIG_PRINTK)
|
|
extern void __printk_hook_install(int (*fn)(int));
|
|
#else
|
|
#define __printk_hook_install(x) \
|
|
do {/* nothing */ \
|
|
} while ((0))
|
|
#endif
|
|
|
|
/**
|
|
* @brief Install printk/stdout hook for Xtensa Simulator console output
|
|
* @return N/A
|
|
*/
|
|
static void xt_sim_console_hook_install(void)
|
|
{
|
|
__stdout_hook_install(console_out);
|
|
__printk_hook_install(console_out);
|
|
}
|
|
|
|
/**
|
|
* @brief Initialize the console/debug port
|
|
* @return 0 if successful, otherwise failed.
|
|
*/
|
|
static int xt_sim_console_init(const struct device *arg)
|
|
{
|
|
ARG_UNUSED(arg);
|
|
xt_sim_console_hook_install();
|
|
return 0;
|
|
}
|
|
|
|
/* UART consloe initializes after the UART device itself */
|
|
SYS_INIT(xt_sim_console_init,
|
|
#if defined(CONFIG_EARLY_CONSOLE)
|
|
PRE_KERNEL_1,
|
|
#else
|
|
POST_KERNEL,
|
|
#endif
|
|
CONFIG_CONSOLE_INIT_PRIORITY);
|