ef14c9b867
Add a zephyr/printk.h header for the __printk_hook functions, these are currently manually declared by all console drivers for no good reason. Move the documentation into the header and also unify the way that console drivers call the function. Signed-off-by: Fabio Baltieri <fabiobaltieri@google.com>
83 lines
1.8 KiB
C
83 lines
1.8 KiB
C
/*
|
|
* Copyright (c) 2022 Intel Corporation
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr/device.h>
|
|
#include <zephyr/init.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/sys/winstream.h>
|
|
#include <zephyr/sys/printk-hooks.h>
|
|
#include <zephyr/devicetree.h>
|
|
#include <zephyr/cache.h>
|
|
|
|
#include <adsp_memory.h>
|
|
#include <mem_window.h>
|
|
|
|
struct k_spinlock trace_lock;
|
|
|
|
static struct sys_winstream *winstream;
|
|
|
|
void winstream_console_trace_out(int8_t *str, size_t len)
|
|
{
|
|
if (len == 0) {
|
|
return;
|
|
}
|
|
|
|
#ifdef CONFIG_ADSP_TRACE_SIMCALL
|
|
register int a2 __asm__("a2") = 4; /* SYS_write */
|
|
register int a3 __asm__("a3") = 1; /* fd 1 == stdout */
|
|
register int a4 __asm__("a4") = (int)str;
|
|
register int a5 __asm__("a5") = len;
|
|
|
|
__asm__ volatile("simcall" : "+r"(a2), "+r"(a3) : "r"(a4), "r"(a5) : "memory");
|
|
#endif
|
|
|
|
k_spinlock_key_t key = k_spin_lock(&trace_lock);
|
|
|
|
sys_winstream_write(winstream, str, len);
|
|
k_spin_unlock(&trace_lock, key);
|
|
}
|
|
|
|
int arch_printk_char_out(int c)
|
|
{
|
|
int8_t s = c;
|
|
|
|
winstream_console_trace_out(&s, 1);
|
|
return 0;
|
|
}
|
|
|
|
#if defined(CONFIG_STDOUT_CONSOLE)
|
|
extern void __stdout_hook_install(int (*hook)(int));
|
|
#endif
|
|
|
|
static void winstream_console_hook_install(void)
|
|
{
|
|
#if defined(CONFIG_STDOUT_CONSOLE)
|
|
__stdout_hook_install(arch_printk_char_out);
|
|
#endif
|
|
#if defined(CONFIG_PRINTK)
|
|
__printk_hook_install(arch_printk_char_out);
|
|
#endif
|
|
}
|
|
|
|
|
|
static int winstream_console_init(void)
|
|
{
|
|
const struct device *dev = DEVICE_DT_GET(DT_CHOSEN(zephyr_console));
|
|
|
|
if (!device_is_ready(dev)) {
|
|
return -ENODEV;
|
|
}
|
|
const struct mem_win_config *config = dev->config;
|
|
void *buf =
|
|
sys_cache_uncached_ptr_get((__sparse_force void __sparse_cache *)config->mem_base);
|
|
|
|
winstream = sys_winstream_init(buf, config->size);
|
|
winstream_console_hook_install();
|
|
|
|
return 0;
|
|
}
|
|
|
|
SYS_INIT(winstream_console_init, PRE_KERNEL_1, CONFIG_CONSOLE_INIT_PRIORITY);
|