You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
80 lines
1.6 KiB
80 lines
1.6 KiB
/* |
|
* Copyright (c) 2020 Intel Corporation |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
|
|
#include <zephyr/kernel.h> |
|
#include <zephyr/device.h> |
|
#include <zephyr/init.h> |
|
#include <zephyr/drivers/ipm.h> |
|
#include <zephyr/sys/printk-hooks.h> |
|
#include <zephyr/sys/libc-hooks.h> |
|
|
|
#include <zephyr/logging/log.h> |
|
LOG_MODULE_REGISTER(ipm_console, CONFIG_IPM_LOG_LEVEL); |
|
|
|
const struct device *ipm_dev; |
|
|
|
static int console_out(int c) |
|
{ |
|
static char buf[CONFIG_IPM_CONSOLE_LINE_BUF_LEN]; |
|
static size_t len; |
|
int ret; |
|
|
|
if (c != '\n' && len < sizeof(buf)) { |
|
buf[len++] = c; |
|
return c; |
|
} |
|
|
|
ret = ipm_send(ipm_dev, 1, len, buf, len); |
|
if (ret) { |
|
LOG_ERR("Error sending character %c over IPM, ret %d", c, ret); |
|
} |
|
|
|
memset(buf, 0, sizeof(buf)); |
|
len = 0; |
|
|
|
/* After buffer is full start a new one */ |
|
if (c != '\n') { |
|
buf[len++] = c; |
|
} |
|
|
|
return c; |
|
} |
|
|
|
/* Install printk/stdout hooks */ |
|
static void ipm_console_hook_install(void) |
|
{ |
|
#if defined(CONFIG_STDOUT_CONSOLE) |
|
__stdout_hook_install(console_out); |
|
#endif |
|
#if defined(CONFIG_PRINTK) |
|
__printk_hook_install(console_out); |
|
#endif |
|
} |
|
|
|
static int ipm_console_init(void) |
|
{ |
|
|
|
LOG_DBG("IPM console initialization"); |
|
|
|
ipm_dev = DEVICE_DT_GET(DT_CHOSEN(zephyr_console)); |
|
if (!device_is_ready(ipm_dev)) { |
|
LOG_ERR("%s is not ready", ipm_dev->name); |
|
return -ENODEV; |
|
} |
|
|
|
if (ipm_max_id_val_get(ipm_dev) < CONFIG_IPM_CONSOLE_LINE_BUF_LEN) { |
|
LOG_ERR("IPM driver does not support buffer length %d", |
|
CONFIG_IPM_CONSOLE_LINE_BUF_LEN); |
|
return -ENOTSUP; |
|
} |
|
|
|
ipm_console_hook_install(); |
|
|
|
return 0; |
|
} |
|
|
|
/* Need to be initialized after IPM */ |
|
SYS_INIT(ipm_console_init, POST_KERNEL, CONFIG_CONSOLE_INIT_PRIORITY);
|
|
|