Workshop o mikrokontrolérech na SKSP 2024.
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.
 
 
 
 
 
 

465 lines
9.8 KiB

/*
* UCW Library -- Logging
*
* (c) 1997--2009 Martin Mares <mj@ucw.cz>
* (c) 2008 Tomas Gavenciak <gavento@ucw.cz>
* (c) 2014 Tomas Valla <tom@ucw.cz>
* (c) 2020 Pavel Charvat <pchar@ucw.cz>
*
* This software may be freely distributed and used according to the terms
* of the GNU Lesser General Public License.
*/
#include <ucw/lib.h>
#include <ucw/log.h>
#include <ucw/log-internal.h>
#include <ucw/simple-lists.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/time.h>
#include <time.h>
#include <alloca.h>
#include <errno.h>
char *log_title;
int log_pid;
void (*log_die_hook)(void);
static void NONRET do_die(void);
/*** The default log stream, which logs to stderr ***/
static int default_log_handler(struct log_stream *ls UNUSED, struct log_msg *m)
{
// This is a completely bare version of the log-file module. Errors are ignored.
if (write(2, m->m, m->m_len) < 0)
{
}
return 0;
}
struct log_stream log_stream_default = {
.name = "stderr",
.use_count = 1000000,
.handler = default_log_handler,
.levels = ~0U,
.types = ~0U,
.msgfmt = LSFMT_DEFAULT,
// an empty clist
.substreams.head = {
.next = (cnode *) &log_stream_default.substreams.head,
.prev = (cnode *) &log_stream_default.substreams.head,
},
};
/*** Registry of streams and their identifiers ***/
struct lsbuf_t log_streams; /* A growing array of pointers to log_streams */
int log_streams_after = 0; /* The first never-used index in log_streams.ptr */
/*
* Find a stream by its identifier given as LS_SET_STRNUM(flags).
* Returns NULL if the stream doesn't exist or it's invalid.
*
* If the log-stream machinery has not been initialized (which is normal for programs
* with no fancy logging), the log_streams gbuf is empty and this function only
* translates stream #0 to the static log_stream_default.
*/
struct log_stream *
log_stream_by_flags(uint flags)
{
int n = LS_GET_STRNUM(flags);
if (n < 0 || n >= log_streams_after || log_streams.ptr[n]->regnum == -1)
return (n ? NULL : &log_stream_default);
return log_streams.ptr[n];
}
/*** Known message types ***/
char **log_type_names;
char *
log_type_name(uint flags)
{
uint type = LS_GET_TYPE(flags);
if (!log_type_names || !log_type_names[type])
return "default";
else
return log_type_names[type];
}
/*** Logging ***/
void
vmsg(uint cat, const char *fmt, va_list args)
{
int saved_errno = errno;
struct timeval tv;
struct tm tm;
va_list args2;
char stime[24];
char sutime[12];
char msgbuf[256];
char *p;
int len;
uint sighandler = cat & L_SIGHANDLER;
struct log_stream *ls;
struct log_msg m = { .flags = cat };
/* Find the destination stream */
if (sighandler)
ls = &log_stream_default;
else if (!(ls = log_stream_by_flags(cat)))
{
msg((LS_CTRL_MASK&cat)|L_WARN, "No log_stream with number %d! Logging to the default log.", LS_GET_STRNUM(cat));
ls = &log_stream_default;
}
/* Get the current time */
if (!sighandler)
{
/* CAVEAT: These calls are not safe in signal handlers. */
gettimeofday(&tv, NULL);
m.tv = &tv;
if (localtime_r(&tv.tv_sec, &tm))
m.tm = &tm;
}
/* Generate time strings */
if (m.tm)
{
strftime(stime, sizeof(stime), "%Y-%m-%d %H:%M:%S", &tm);
snprintf(sutime, sizeof(sutime), ".%06d", (int)tv.tv_usec);
m.stime = stime;
m.sutime = sutime;
}
else
{
m.stime = "\?\?\?\?-\?\?-\?\? \?\?:\?\?:\?\?";
m.sutime = ".\?\?\?\?\?\?";
}
/* Generate the message string */
va_copy(args2, args);
errno = saved_errno;
len = vsnprintf(msgbuf, sizeof(msgbuf), fmt, args2);
va_end(args2);
if (len < (int) sizeof(msgbuf) || sighandler)
m.raw_msg = msgbuf;
else
{
m.raw_msg = xmalloc(len+1);
errno = saved_errno;
vsnprintf(m.raw_msg, len+1, fmt, args);
}
/* Remove non-printable characters and newlines */
p = m.raw_msg;
while (*p)
{
if (*p >= 0 && *p < 0x20 && *p != '\t')
*p = 0x7f;
p++;
}
/* Pass the message to the log_stream */
log_pass_msg(ls, &m);
if (m.error)
{
/* Error (such as infinite loop) occurred */
log_pass_msg(&log_stream_default, &m);
}
if (m.raw_msg != msgbuf)
xfree(m.raw_msg);
errno = saved_errno;
}
static void
log_report_err(struct log_stream *ls, struct log_msg *m, int err)
{
if (m->flags & L_LOGGER_ERR)
return;
if (ls->stream_flags & LSFLAG_ERR_REPORTED)
return;
ls->stream_flags |= LSFLAG_ERR_REPORTED;
struct log_msg errm = *m;
char errbuf[128];
char *name = (ls->name ? : "<unnamed>");
errm.flags = ((ls->stream_flags & LSFLAG_ERR_IS_FATAL) ? L_FATAL : L_ERROR);
errm.flags |= L_LOGGER_ERR | (m->flags & LS_CTRL_MASK);
errm.raw_msg = errbuf;
if (err == EDEADLK)
snprintf(errbuf, sizeof(errbuf), "Error logging to %s: Maximum nesting level of log streams exceeded", name);
else
{
errno = err;
snprintf(errbuf, sizeof(errbuf), "Error logging to %s: %m", name);
}
log_pass_msg(&log_stream_default, &errm);
if (ls->stream_flags & LSFLAG_ERR_IS_FATAL)
do_die();
}
/* Maximal depth of log_pass_msg recursion */
#define LS_MAX_DEPTH 64
void
log_pass_filtered(struct log_stream *ls, struct log_msg *m)
{
/* Pass the message to substreams */
CLIST_FOR_EACH(simp_node *, s, ls->substreams)
{
log_pass_msg(s->p, m);
if (m->error)
return;
}
/* Will pass to the handler of this stream... is there any? */
if (!ls->handler)
return;
/* Will print a message type? */
char *type = NULL;
if ((ls->msgfmt & LSFMT_TYPE) && LS_GET_TYPE(m->flags))
type = log_type_name(m->flags);
/* Upper bound on message length */
int len = strlen(m->raw_msg) + strlen(m->stime) + strlen(m->sutime) + 32;
if (log_title)
len += strlen(log_title);
if (ls->name)
len += strlen(ls->name);
if (type)
len += strlen(type) + 3;
/* Get a buffer and format the message */
char *free_buf = NULL;
if (len <= 256 || (m->flags & L_SIGHANDLER))
m->m = alloca(len);
else
m->m = free_buf = xmalloc(len);
char *p = m->m;
/* Level (2 chars) */
if (ls->msgfmt & LSFMT_LEVEL)
{
*p++ = LS_LEVEL_LETTER(LS_GET_LEVEL(m->flags));
*p++ = ' ';
}
/* Time (|stime| + |sutime| + 1 chars) */
if (ls->msgfmt & LSFMT_TIME)
{
const char *q = m->stime;
while (*q)
*p++ = *q++;
if (ls->msgfmt & LSFMT_USEC)
{
q = m->sutime;
while (*q)
*p++ = *q++;
}
*p++ = ' ';
}
/* Process name, PID ( |log_title| + 6 + (|PID|<=10) chars ) */
if ((ls->msgfmt & LSFMT_TITLE) && log_title)
{
if ((ls->msgfmt & LSFMT_PID) && log_pid)
p += sprintf(p, "[%s (%d)] ", log_title, log_pid);
else
p += sprintf(p, "[%s] ", log_title);
}
else
{
if ((ls->msgfmt & LSFMT_PID) && log_pid)
p += sprintf(p, "[%d] ", log_pid);
}
/* log_stream name ( |ls->name| + 4 chars ) */
if (ls->msgfmt & LSFMT_LOGNAME)
{
if (ls->name)
p += sprintf(p, "<%s> ", ls->name);
else
p += sprintf(p, "<?> ");
}
/* Message type ( |type| + 3 chars ) */
if (type)
p += sprintf(p, "{%s} ", type);
/* The message itself ( |m| + 1 chars ) */
{
const char *q = m->raw_msg;
while (*q)
*p++ = *q++;
*p++ = '\n';
*p = '\0';
m->m_len = p - m->m;
int err = ls->handler(ls, m);
if (err)
log_report_err(ls, m, err);
}
if (free_buf)
xfree(free_buf);
}
void
log_pass_msg(struct log_stream *ls, struct log_msg *m)
{
ASSERT(ls);
/* Check recursion depth */
if (m->depth > LS_MAX_DEPTH)
{
log_report_err(ls, m, EDEADLK);
m->error = 1;
return;
}
/* Filter by level and type */
if (!((1 << LS_GET_LEVEL(m->flags)) & ls->levels) ||
!((1 << LS_GET_TYPE(m->flags)) & ls->types))
return;
m->depth++;
if (ls->filter && ls->filter(ls, m))
{
// The filter might have called log_pass_filtered()
}
else
log_pass_filtered(ls, m);
m->depth--;
}
/*** Utility functions ***/
void
msg(uint cat, const char *fmt, ...)
{
va_list args;
va_start(args, fmt);
vmsg(cat, fmt, args);
va_end(args);
}
static void NONRET
do_die(void)
{
#ifdef DEBUG_DIE_BY_ABORT
abort();
#else
const char *env = getenv(CONFIG_UCW_ENV_VAR_DIE_BY_ABORT);
if (env && *env)
abort();
exit(1);
#endif
}
void
vdie(const char *fmt, va_list args)
{
vmsg(L_FATAL, fmt, args);
if (log_die_hook)
log_die_hook();
do_die();
}
void
die(const char *fmt, ...)
{
va_list args;
va_start(args, fmt);
vdie(fmt, args);
}
void
assert_failed(const char *assertion, const char *file, int line)
{
msg(L_FATAL, "Assertion `%s' failed at %s:%d", assertion, file, line);
abort();
}
void
assert_failed_msg(const char *assertion, const char *file, int line, const char *fmt, ...)
{
va_list args;
va_start(args, fmt);
vmsg(L_DEBUG, fmt, args);
msg(L_FATAL, "Assertion `%s' failed at %s:%d", assertion, file, line);
abort();
}
void
assert_failed_noinfo(void)
{
die("Internal error: Assertion failed.");
}
static const char *
log_basename(const char *n)
{
const char *p = n;
while (*n)
if (*n++ == '/')
p = n;
return p;
}
void
log_init(const char *argv0)
{
if (argv0)
{
static char log_progname[32];
strncpy(log_progname, log_basename(argv0), sizeof(log_progname)-1);
log_progname[sizeof(log_progname)-1] = 0;
log_title = log_progname;
}
}
void
log_fork(void)
{
log_pid = getpid();
}
#ifdef TEST
#include <syslog.h>
int main(void)
{
int type = log_find_type("foo");
ASSERT(type < 0);
type = log_register_type("foo");
struct log_stream *ls = log_new_syslog("local3", 0);
#if 0
log_add_substream(ls, ls);
ls->stream_flags |= LSFLAG_ERR_IS_FATAL;
#endif
msg(L_INFO | ls->regnum, "Brum <%300s>", ":-)");
log_set_format(log_default_stream(), ~0U, LSFMT_USEC | LSFMT_TYPE);
msg(L_INFO | type, "Brum <%300s>", ":-)");
log_close_all();
return 0;
}
#endif