debug.c

Go to the documentation of this file.

/*
 * Copyright (c) 2010-2011 Vojtech Horky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <adt/list.h>
#include <fibril_synch.h>
#include <errno.h>
#include <stdlib.h>
#include <stdio.h>
#include <usb/debug.h>

static usb_log_level_t log_level = USB_LOG_LEVEL_WARNING;

static const char *log_prefix = "usb";

static FIBRIL_MUTEX_INITIALIZE(log_serializer);

static FILE *log_stream = NULL;


void usb_log_enable(usb_log_level_t level, const char *message_prefix)
{
        log_prefix = message_prefix;
        log_level = level;
        if (log_stream == NULL) {
                char *fname;
                int rc = asprintf(&fname, "/log/%s", message_prefix);
                if (rc > 0) {
                        log_stream = fopen(fname, "w");
                        free(fname);
                }
        }
}

static const char *log_level_name(usb_log_level_t level)
{
        switch (level) {
                case USB_LOG_LEVEL_FATAL:
                        return " FATAL";
                case USB_LOG_LEVEL_ERROR:
                        return " ERROR";
                case USB_LOG_LEVEL_WARNING:
                        return " WARN";
                case USB_LOG_LEVEL_INFO:
                        return " info";
                default:
                        return "";
        }
}

void usb_log_printf(usb_log_level_t level, const char *format, ...)
{
        FILE *screen_stream = NULL;
        switch (level) {
                case USB_LOG_LEVEL_FATAL:
                case USB_LOG_LEVEL_ERROR:
                        screen_stream = stderr;
                        break;
                default:
                        screen_stream = stdout;
                        break;
        }
        assert(screen_stream != NULL);

        va_list args;

        /*
         * Serialize access to log files.
         * Print to screen only messages with higher level than the one
         * specified during logging initialization.
         * Print also to file, to it print one more (lower) level as well.
         */
        fibril_mutex_lock(&log_serializer);

        const char *level_name = log_level_name(level);

        if ((log_stream != NULL) && (level <= log_level + 1)) {
                va_start(args, format);

                fprintf(log_stream, "[%s]%s: ", log_prefix, level_name);
                vfprintf(log_stream, format, args);
                fflush(log_stream);

                va_end(args);
        }

        if (level <= log_level) {
                va_start(args, format);

                fprintf(screen_stream, "[%s]%s: ", log_prefix, level_name);
                vfprintf(screen_stream, format, args);
                fflush(screen_stream);

                va_end(args);
        }

        fibril_mutex_unlock(&log_serializer);
}


#define REMAINDER_STR_FMT " (%zu)..."
/* string + terminator + number width (enough for 4GB)*/
#define REMAINDER_STR_LEN (5 + 1 + 10)

#define BUFFER_DUMP_GROUP_SIZE 4

#define BUFFER_DUMP_LEN 240 /* Ought to be enough for everybody ;-). */

static fibril_local char buffer_dump[2][BUFFER_DUMP_LEN];
static fibril_local int buffer_dump_index = 0;

const char *usb_debug_str_buffer(const uint8_t *buffer, size_t size,
    size_t dumped_size)
{
        /*
         * Remove previous string.
         */
        bzero(buffer_dump[buffer_dump_index], BUFFER_DUMP_LEN);

        if (buffer == NULL) {
                return "(null)";
        }
        if (size == 0) {
                return "(empty)";
        }
        if ((dumped_size == 0) || (dumped_size > size)) {
                dumped_size = size;
        }

        /* How many bytes are available in the output buffer. */
        size_t buffer_remaining_size = BUFFER_DUMP_LEN - 1 - REMAINDER_STR_LEN;
        char *it = buffer_dump[buffer_dump_index];

        size_t index = 0;

        while (index < size) {
                /* Determine space before the number. */
                const char *space_before;
                if (index == 0) {
                        space_before = "";
                } else if ((index % BUFFER_DUMP_GROUP_SIZE) == 0) {
                        space_before = "  ";
                } else {
                        space_before = " ";
                }

                /*
                 * Add the byte as a hexadecimal number plus the space.
                 * We do it into temporary buffer to ensure that always
                 * the whole byte is printed.
                 */
                int val = buffer[index];
                char current_byte[16];
                int printed = snprintf(current_byte, 16,
                    "%s%02x", space_before, val);
                if (printed < 0) {
                        break;
                }

                if ((size_t) printed > buffer_remaining_size) {
                        break;
                }

                /* We can safely add 1, because space for end 0 is reserved. */
                str_append(it, buffer_remaining_size + 1, current_byte);

                buffer_remaining_size -= printed;
                /* Point at the terminator 0. */
                it += printed;
                index++;

                if (index >= dumped_size) {
                        break;
                }
        }

        /* Add how many bytes were not printed. */
        if (index < size) {
                snprintf(it, REMAINDER_STR_LEN,
                    REMAINDER_STR_FMT, size - index);
        }

        /* Next time, use the other buffer. */
        buffer_dump_index = 1 - buffer_dump_index;

        /* Need to take the old one due to previous line. */
        return buffer_dump[1 - buffer_dump_index];
}

---