123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533 |
- /*
- * Copyright (c) 2017-2019 Richard Braun.
- *
- * This program is free software: you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation, either version 3 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
- */
- #include <assert.h>
- #include <errno.h>
- #include <limits.h>
- #include <stdarg.h>
- #include <stdbool.h>
- #include <stddef.h>
- #include <stdio.h>
- #include <stdint.h>
- #include <string.h>
- #include <kern/arg.h>
- #include <kern/bulletin.h>
- #include <kern/init.h>
- #include <kern/log.h>
- #include <kern/macros.h>
- #include <kern/mbuf.h>
- #include <kern/panic.h>
- #include <kern/shell.h>
- #include <kern/spinlock.h>
- #include <kern/thread.h>
- #include <machine/boot.h>
- #include <machine/cpu.h>
- #define LOG_BUFFER_SIZE 16384
- #if !ISP2(LOG_BUFFER_SIZE)
- #error "log buffer size must be a power-of-two"
- #endif
- #define LOG_MSG_SIZE 128
- #define LOG_PRINT_LEVEL LOG_INFO
- static struct thread *log_thread;
- static struct mbuf log_mbuf;
- static char log_buffer[LOG_BUFFER_SIZE];
- static unsigned int log_nr_overruns;
- static struct bulletin log_bulletin;
- /*
- * Global lock.
- *
- * Interrupts must be disabled when holding this lock.
- */
- static struct spinlock log_lock;
- struct log_record {
- uint8_t level;
- char msg[LOG_MSG_SIZE];
- };
- struct log_consumer {
- struct mbuf *mbuf;
- size_t index;
- };
- static void
- log_consumer_init(struct log_consumer *ctx, struct mbuf *mbuf)
- {
- ctx->mbuf = mbuf;
- ctx->index = mbuf_start(mbuf);
- }
- static int
- log_consumer_pop(struct log_consumer *ctx, struct log_record *record)
- {
- size_t size;
- int error;
- for (;;) {
- size = sizeof(*record);
- error = mbuf_read(ctx->mbuf, &ctx->index, record, &size);
- if (error != EINVAL) {
- break;
- } else {
- ctx->index = mbuf_start(ctx->mbuf);
- }
- }
- return error;
- }
- static const char *
- log_level2str(unsigned int level)
- {
- switch (level) {
- case LOG_EMERG:
- return "emerg";
- case LOG_ALERT:
- return "alert";
- case LOG_CRIT:
- return "crit";
- case LOG_ERR:
- return "error";
- case LOG_WARNING:
- return "warning";
- case LOG_NOTICE:
- return "notice";
- case LOG_INFO:
- return "info";
- case LOG_DEBUG:
- return "debug";
- default:
- return NULL;
- }
- }
- static void
- log_print_record(const struct log_record *record, unsigned int level)
- {
- if (record->level > level) {
- return;
- }
- if (record->level <= LOG_WARNING) {
- printf("%7s %s\n", log_level2str(record->level), record->msg);
- } else {
- printf("%s\n", record->msg);
- }
- }
- static void
- log_run(void *arg)
- {
- struct log_consumer ctx;
- unsigned long flags;
- bool published;
- (void)arg;
- published = false;
- spinlock_lock_intr_save(&log_lock, &flags);
- log_consumer_init(&ctx, &log_mbuf);
- for (;;) {
- struct log_record record;
- for (;;) {
- int error;
- error = log_consumer_pop(&ctx, &record);
- if (!error) {
- break;
- } else if (log_nr_overruns != 0) {
- record.level = LOG_ERR;
- snprintf(record.msg, sizeof(record.msg),
- "log: buffer overruns, %u messages dropped",
- log_nr_overruns);
- log_nr_overruns = 0;
- break;
- }
- if (!published) {
- spinlock_unlock_intr_restore(&log_lock, flags);
- bulletin_publish(&log_bulletin, 0);
- spinlock_lock_intr_save(&log_lock, &flags);
- published = true;
- }
- thread_sleep(&log_lock, &log_mbuf, "log_mbuf");
- }
- spinlock_unlock_intr_restore(&log_lock, flags);
- log_print_record(&record, LOG_PRINT_LEVEL);
- spinlock_lock_intr_save(&log_lock, &flags);
- }
- }
- #ifdef CONFIG_SHELL
- static void
- log_dump(unsigned int level)
- {
- struct log_consumer ctx;
- struct log_record record;
- unsigned long flags;
- int error;
- spinlock_lock_intr_save(&log_lock, &flags);
- log_consumer_init(&ctx, &log_mbuf);
- for (;;) {
- error = log_consumer_pop(&ctx, &record);
- if (error) {
- break;
- }
- spinlock_unlock_intr_restore(&log_lock, flags);
- log_print_record(&record, level);
- spinlock_lock_intr_save(&log_lock, &flags);
- }
- spinlock_unlock_intr_restore(&log_lock, flags);
- }
- static void
- log_shell_dump(struct shell *shell, int argc, char **argv)
- {
- unsigned int level;
- int ret;
- (void)shell;
- if (argc != 2) {
- level = LOG_PRINT_LEVEL;
- } else {
- ret = sscanf(argv[1], "%u", &level);
- if ((ret != 1) || (level >= LOG_NR_LEVELS)) {
- printf("log: dump: invalid arguments\n");
- return;
- }
- }
- log_dump(level);
- }
- static struct shell_cmd log_shell_cmds[] = {
- SHELL_CMD_INITIALIZER2("log_dump", log_shell_dump,
- "log_dump [<level>]",
- "dump the log buffer",
- "Only records of level less than or equal to the given level"
- " are printed. Level may be one of :\n"
- " 0: emergency\n"
- " 1: alert\n"
- " 2: critical\n"
- " 3: error\n"
- " 4: warning\n"
- " 5: notice\n"
- " 6: info\n"
- " 7: debug"),
- };
- static int __init
- log_setup_shell(void)
- {
- SHELL_REGISTER_CMDS(log_shell_cmds, shell_get_main_cmd_set());
- return 0;
- }
- INIT_OP_DEFINE(log_setup_shell,
- INIT_OP_DEP(log_setup, true),
- INIT_OP_DEP(shell_setup, true));
- #endif /* CONFIG_SHELL */
- static int __init
- log_setup(void)
- {
- mbuf_init(&log_mbuf, log_buffer, sizeof(log_buffer),
- sizeof(struct log_record));
- spinlock_init(&log_lock);
- bulletin_init(&log_bulletin);
- boot_log_info();
- arg_log_info();
- cpu_log_info(cpu_current());
- return 0;
- }
- INIT_OP_DEFINE(log_setup,
- INIT_OP_DEP(arg_setup, true),
- INIT_OP_DEP(cpu_setup, true),
- INIT_OP_DEP(spinlock_setup, true));
- static int __init
- log_start(void)
- {
- struct thread_attr attr;
- int error;
- thread_attr_init(&attr, THREAD_KERNEL_PREFIX "log_run");
- thread_attr_set_detached(&attr);
- error = thread_create(&log_thread, &attr, log_run, NULL);
- if (error) {
- panic("log: unable to create thread");
- }
- return 0;
- }
- INIT_OP_DEFINE(log_start,
- INIT_OP_DEP(log_setup, true),
- INIT_OP_DEP(thread_setup, true));
- int
- log_msg(unsigned int level, const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vmsg(level, format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_vmsg(unsigned int level, const char *format, va_list ap)
- {
- struct log_record record;
- unsigned long flags;
- int error, nr_chars;
- size_t size;
- char *ptr;
- assert(level < LOG_NR_LEVELS);
- record.level = level;
- nr_chars = vsnprintf(record.msg, sizeof(record.msg), format, ap);
- if ((unsigned int)nr_chars >= sizeof(record.msg)) {
- log_msg(LOG_ERR, "log: message too large");
- goto out;
- }
- ptr = strchr(record.msg, '\n');
- if (ptr != NULL) {
- *ptr = '\0';
- nr_chars = ptr - record.msg;
- }
- assert(nr_chars >= 0);
- size = offsetof(struct log_record, msg) + nr_chars + 1;
- spinlock_lock_intr_save(&log_lock, &flags);
- error = mbuf_push(&log_mbuf, &record, size, true);
- if (error) {
- log_nr_overruns++;
- }
- thread_wakeup(log_thread);
- spinlock_unlock_intr_restore(&log_lock, flags);
- out:
- return nr_chars;
- }
- int
- log_emerg(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vemerg(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_alert(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_valert(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_crit(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vcrit(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_err(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_verr(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_warning(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vwarning(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_notice(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vnotice(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_info(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vinfo(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_debug(const char *format, ...)
- {
- va_list ap;
- int ret;
- va_start(ap, format);
- ret = log_vdebug(format, ap);
- va_end(ap);
- return ret;
- }
- int
- log_vemerg(const char *format, va_list ap)
- {
- return log_vmsg(LOG_EMERG, format, ap);
- }
- int
- log_valert(const char *format, va_list ap)
- {
- return log_vmsg(LOG_ALERT, format, ap);
- }
- int
- log_vcrit(const char *format, va_list ap)
- {
- return log_vmsg(LOG_CRIT, format, ap);
- }
- int
- log_verr(const char *format, va_list ap)
- {
- return log_vmsg(LOG_ERR, format, ap);
- }
- int
- log_vwarning(const char *format, va_list ap)
- {
- return log_vmsg(LOG_WARNING, format, ap);
- }
- int
- log_vnotice(const char *format, va_list ap)
- {
- return log_vmsg(LOG_NOTICE, format, ap);
- }
- int
- log_vinfo(const char *format, va_list ap)
- {
- return log_vmsg(LOG_INFO, format, ap);
- }
- int
- log_vdebug(const char *format, va_list ap)
- {
- return log_vmsg(LOG_DEBUG, format, ap);
- }
- struct bulletin *
- log_get_bulletin(void)
- {
- return &log_bulletin;
- }
|