/* * Copyright (c) 2018 Nordic Semiconductor ASA * Copyright (c) 2023 Meta * * SPDX-License-Identifier: Apache-2.0 */ #include #include #include #include #include #include #include #include #include #include #include #include LOG_MODULE_REGISTER(log_uart); struct lbu_data { struct k_sem sem; uint32_t log_format_current; volatile bool in_panic; bool use_async; }; struct lbu_cb_ctx { const struct log_output *output; #if DT_HAS_CHOSEN(zephyr_log_uart) const struct device *uart_dev; #endif struct lbu_data *data; }; #define LBU_UART_DEV(ctx) \ COND_CODE_1(DT_HAS_CHOSEN(zephyr_log_uart), (ctx->uart_dev), \ (DEVICE_DT_GET(DT_CHOSEN(zephyr_console)))) /* Fixed size to avoid auto-added trailing '\0'. * Used if CONFIG_LOG_BACKEND_UART_OUTPUT_DICTIONARY_HEX. */ static const char LOG_HEX_SEP[10] = "##ZLOGV1##"; static void uart_callback(const struct device *dev, struct uart_event *evt, void *user_data) { const struct lbu_cb_ctx *ctx = user_data; struct lbu_data *data = ctx->data; ARG_UNUSED(dev); switch (evt->type) { case UART_TX_DONE: k_sem_give(&data->sem); break; default: break; } } static void dict_char_out_hex(const struct device *uart_dev, uint8_t *data, size_t length) { for (size_t i = 0; i < length; i++) { char c; uint8_t x; /* upper 8-bit */ x = data[i] >> 4; (void)hex2char(x, &c); uart_poll_out(uart_dev, c); /* lower 8-bit */ x = data[i] & 0x0FU; (void)hex2char(x, &c); uart_poll_out(uart_dev, c); } } static int char_out(uint8_t *data, size_t length, void *ctx) { int err; const struct lbu_cb_ctx *cb_ctx = ctx; struct lbu_data *lb_data = cb_ctx->data; const struct device *uart_dev = LBU_UART_DEV(cb_ctx); if (pm_device_runtime_get(uart_dev) < 0) { /* Enabling the UART instance has failed but this * function MUST return the number of bytes consumed. */ return length; } if (IS_ENABLED(CONFIG_LOG_BACKEND_UART_OUTPUT_DICTIONARY_HEX)) { dict_char_out_hex(uart_dev, data, length); goto cleanup; } if (!IS_ENABLED(CONFIG_LOG_BACKEND_UART_ASYNC) || lb_data->in_panic || !lb_data->use_async) { for (size_t i = 0; i < length; i++) { uart_poll_out(uart_dev, data[i]); } goto cleanup; } err = uart_tx(uart_dev, data, length, SYS_FOREVER_US); __ASSERT_NO_MSG(err == 0); err = k_sem_take(&lb_data->sem, K_FOREVER); __ASSERT_NO_MSG(err == 0); (void)err; cleanup: /* Use async put to avoid useless device suspension/resumption * when tranmiting chain of chars. * As errors cannot be returned, ignore the return value */ (void)pm_device_runtime_put_async(uart_dev, K_MSEC(1)); return length; } static void process(const struct log_backend *const backend, union log_msg_generic *msg) { const struct lbu_cb_ctx *ctx = backend->cb->ctx; struct lbu_data *data = ctx->data; uint32_t flags = log_backend_std_get_flags(); log_format_func_t log_output_func = log_format_func_t_get(data->log_format_current); log_output_func(ctx->output, &msg->log, flags); } static int format_set(const struct log_backend *const backend, uint32_t log_type) { const struct lbu_cb_ctx *ctx = backend->cb->ctx; struct lbu_data *data = ctx->data; data->log_format_current = log_type; return 0; } static void log_backend_uart_init(struct log_backend const *const backend) { const struct lbu_cb_ctx *ctx = backend->cb->ctx; const struct device *uart_dev = LBU_UART_DEV(ctx); struct lbu_data *data = ctx->data; __ASSERT_NO_MSG(device_is_ready(uart_dev)); log_output_ctx_set(ctx->output, (void *)ctx); if (IS_ENABLED(CONFIG_LOG_BACKEND_UART_OUTPUT_DICTIONARY_HEX)) { /* Print a separator so the output can be fed into * log parser directly. This is useful when capturing * from UART directly where there might be other output * (e.g. bootloader). */ for (int i = 0; i < sizeof(LOG_HEX_SEP); i++) { uart_poll_out(uart_dev, LOG_HEX_SEP[i]); } return; } if (IS_ENABLED(CONFIG_LOG_BACKEND_UART_ASYNC)) { int err = uart_callback_set(uart_dev, uart_callback, (void *)ctx); if (err == 0) { data->use_async = true; k_sem_init(&data->sem, 0, 1); } else { LOG_WRN("Failed to initialize asynchronous mode (err:%d). " "Fallback to polling.", err); } } } static void panic(struct log_backend const *const backend) { const struct lbu_cb_ctx *ctx = backend->cb->ctx; struct lbu_data *data = ctx->data; const struct device *uart_dev = LBU_UART_DEV(ctx); /* Ensure that the UART device is in active mode */ #if defined(CONFIG_PM_DEVICE_RUNTIME) (void)pm_device_runtime_get(uart_dev); #elif defined(CONFIG_PM_DEVICE) enum pm_device_state pm_state; int rc; rc = pm_device_state_get(uart_dev, &pm_state); if ((rc == 0) && (pm_state == PM_DEVICE_STATE_SUSPENDED)) { pm_device_action_run(uart_dev, PM_DEVICE_ACTION_RESUME); } #else ARG_UNUSED(uart_dev); #endif /* CONFIG_PM_DEVICE */ data->in_panic = true; log_backend_std_panic(ctx->output); } static void dropped(const struct log_backend *const backend, uint32_t cnt) { const struct lbu_cb_ctx *ctx = backend->cb->ctx; if (IS_ENABLED(CONFIG_LOG_BACKEND_UART_OUTPUT_DICTIONARY)) { log_dict_output_dropped_process(ctx->output, cnt); } else { log_backend_std_dropped(ctx->output, cnt); } } const struct log_backend_api log_backend_uart_api = { .process = process, .panic = panic, .init = log_backend_uart_init, .dropped = IS_ENABLED(CONFIG_LOG_MODE_IMMEDIATE) ? NULL : dropped, .format_set = format_set, }; #define LBU_DEFINE(node_id, ...) \ static uint8_t lbu_buffer##__VA_ARGS__[CONFIG_LOG_BACKEND_UART_BUFFER_SIZE]; \ LOG_OUTPUT_DEFINE(lbu_output##__VA_ARGS__, char_out, lbu_buffer##__VA_ARGS__, \ CONFIG_LOG_BACKEND_UART_BUFFER_SIZE); \ \ static struct lbu_data lbu_data##__VA_ARGS__ = { \ .log_format_current = CONFIG_LOG_BACKEND_UART_OUTPUT_DEFAULT, \ }; \ \ static const struct lbu_cb_ctx lbu_cb_ctx##__VA_ARGS__ = { \ .output = &lbu_output##__VA_ARGS__, \ COND_CODE_0(NUM_VA_ARGS_LESS_1(_, ##__VA_ARGS__), (), \ (.uart_dev = DEVICE_DT_GET(node_id),)) \ .data = &lbu_data##__VA_ARGS__, \ }; \ \ LOG_BACKEND_DEFINE(log_backend_uart##__VA_ARGS__, log_backend_uart_api, \ IS_ENABLED(CONFIG_LOG_BACKEND_UART_AUTOSTART), \ (void *)&lbu_cb_ctx##__VA_ARGS__); #if DT_HAS_CHOSEN(zephyr_log_uart) #define LBU_PHA_FN(node_id, prop, idx) LBU_DEFINE(DT_PHANDLE_BY_IDX(node_id, prop, idx), idx) DT_FOREACH_PROP_ELEM_SEP(DT_CHOSEN(zephyr_log_uart), uarts, LBU_PHA_FN, ()); #else LBU_DEFINE(DT_CHOSEN(zephyr_console)); #endif