- convert all files to unix line-ending

[fw/openocd] / src / helper / log.c

diff --git a/src/helper/log.c b/src/helper/log.c
index 4cdcfc8724d68e56a6cfbe921c68e322ed7406c6..861e4b376859823413491f31b1ff62ffc2c2ceff 100644 (file)
--- a/src/helper/log.c
+++ b/src/helper/log.c
@@ -33,22 +33,17 @@
 int debug_level = -1;
 
 static FILE* log_output;
+static log_callback_t *log_callbacks = NULL;
 
-static void *privData;
-static logCallback callback;
+static time_t start;
 
-void log_setCallback(logCallback c, void *p)
-{
-       callback = c;
-       privData = p;
-}
-
-static char *log_strings[4] = 
+static char *log_strings[5] =
 {
+       "User:   ",
        "Error:  ",
        "Warning:",
        "Info:   ",
-       "Debug:  ",
+       "Debug:  "
 };
 
 void log_printf(enum log_levels level, const char *file, int line, const char *function, const char *format, ...)
@@ -57,28 +52,50 @@ void log_printf(enum log_levels level, const char *file, int line, const char *f
        count++;
        va_list args;
        char buffer[512];
+       log_callback_t *cb;
 
        if (level > debug_level)
                return;
 
        va_start(args, format);
        vsnprintf(buffer, 512, format, args);
+       va_end(args);
+
+       if (level == LOG_OUTPUT)
+       {
+               /* do not prepend any headers, just print out what we were given and return */
+               fputs(buffer, log_output);
+               fflush(log_output);
+               return;
+       }
 
        char *f = strrchr(file, '/');
        if (f != NULL)
                file = f + 1;
 
-       fprintf(log_output, "%s %d %ld %s:%d %s(): %s\n", log_strings[level], count, time(NULL), file, line, function, buffer);
+       if (debug_level >= LOG_DEBUG)
+       {
+               /* print with count and time information */
+               time_t t=time(NULL)-start;
+               fprintf(log_output, "%s %d %ld %s:%d %s(): %s\n", log_strings[level+1], count, t, file, line, function, buffer);
+       }
+       else
+       {
+               /* do not print count and time */
+               fprintf(log_output, "%s %s:%d %s(): %s\n", log_strings[level+1], file, line, function, buffer);
+       }
+
        fflush(log_output);
        
-       va_end(args);
-
        /* Never forward LOG_DEBUG, too verbose and they can be found in the log if need be */
-       if (callback && (level <= LOG_INFO))
+       if (level <= LOG_INFO)
        {
-               va_start(args, format);
-               callback(privData, file, line, function, format, args);
-               va_end(args);
+               for (cb = log_callbacks; cb; cb = cb->next)
+               {
+                       va_start(args, format);
+                       cb->fn(cb->priv, file, line, function, format, args);
+                       va_end(args);
+               }
        }
 }
 
@@ -122,6 +139,7 @@ int handle_log_output_command(struct command_context_s *cmd_ctx, char *cmd, char
 
 int log_register_commands(struct command_context_s *cmd_ctx)
 {
+       start = time(NULL);
        register_command(cmd_ctx, NULL, "log_output", handle_log_output_command,
                COMMAND_ANY, "redirect logging to <file> (default: stderr)");
        register_command(cmd_ctx, NULL, "debug_level", handle_debug_level_command,
@@ -150,8 +168,51 @@ int set_log_output(struct command_context_s *cmd_ctx, FILE *output)
        return ERROR_OK;
 }
 
+/* add/remove log callback handler */
+int log_add_callback(log_callback_fn fn, void *priv)
+{
+       log_callback_t *cb;
+
+       /* prevent the same callback to be registered more than once, just for sure */
+       for (cb = log_callbacks; cb; cb = cb->next)
+       {
+               if (cb->fn == fn && cb->priv == priv)
+                       return ERROR_INVALID_ARGUMENTS;
+       }
+
+       /* alloc memory, it is safe just to return in case of an error, no need for the caller to check this */
+       if ((cb = malloc(sizeof(log_callback_t))) == NULL)
+               return ERROR_BUF_TOO_SMALL;
+
+       /* add item to the beginning of the linked list */
+       cb->fn = fn;
+       cb->priv = priv;
+       cb->next = log_callbacks;
+       log_callbacks = cb;
+
+       return ERROR_OK;
+}
+
+int log_remove_callback(log_callback_fn fn, void *priv)
+{
+       log_callback_t *cb, **p;
+
+       for (p = &log_callbacks; cb = *p; p = &(*p)->next)
+       {
+           if (cb->fn == fn && cb->priv == priv)
+           {
+               *p = cb->next;
+                       free(cb);
+                       return ERROR_OK;
+               }
+       }
+
+       /* no such item */
+       return ERROR_INVALID_ARGUMENTS;
+}
+
 /* return allocated string w/printf() result */
-char *allocPrintf(const char *fmt, va_list ap)
+char *alloc_printf(const char *fmt, va_list ap)
 {
        char *string = NULL;