/* nbdkit
 * Copyright Red Hat
 *
 * 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.
 *
 * * Neither the name of Red Hat nor the names of its contributors may be
 * used to endorse or promote products derived from this software without
 * specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY RED HAT AND CONTRIBUTORS ''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 RED HAT OR
 * CONTRIBUTORS 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 <config.h>

#include <stdio.h>
#include <stdlib.h>
#include <stdbool.h>
#include <stdint.h>
#include <stdarg.h>
#include <inttypes.h>
#include <string.h>
#include <unistd.h>
#include <errno.h>

#include "ansi-colours.h"
#include "ascii-ctype.h"
#include "isaligned.h"
#include "open_memstream.h"
#include "rounding.h"
#include "utils.h"

#include "internal.h"
#undef nbdkit_debug

static void
prologue (FILE *fp)
{
  const char *name = threadlocal_get_name ();
  size_t instance_num = threadlocal_get_instance_num ();

  fprintf (fp, "%s", program_name);
  if (process_name)             /* --name parameter */
    fprintf (fp, "[%s]", process_name);
  fprintf (fp, ": ");

  if (name) {
    fprintf (fp, "%s", name);
    if (instance_num > 0)
      fprintf (fp, "[%zu]", instance_num);
    fprintf (fp, ": ");
  }

  fprintf (fp, "debug: ");
}

/* Common debug function.
 * Note: preserves the previous value of errno.
 */
static void
debug_common (bool in_server, const char *fs, va_list args)
{
  if (!verbose)
    return;

  int err = errno;
#ifndef WIN32
  const int tty = isatty (fileno (stderr));
#else
  const int tty = 0;
#endif
  CLEANUP_FREE char *str_inner = NULL;
  CLEANUP_FREE char *str_outer = NULL;
  FILE *fp_inner, *fp_outer;
  size_t len_inner = 0, len_outer = 0;

  /* The "inner" string is the debug string before escaping. */
  fp_inner = open_memstream (&str_inner, &len_inner);
  if (fp_inner == NULL)
    goto fail;
  errno = err; /* so %m works */
  vfprintf (fp_inner, fs, args);
  if (close_memstream (fp_inner) == -1)
    goto fail;

  /* The "outer" string contains the prologue, escaped debug string and \n. */
  fp_outer = open_memstream (&str_outer, &len_outer);
  if (fp_outer == NULL) goto fail;

  if (!in_server && tty) ansi_force_colour (ANSI_FG_BOLD_BLACK, fp_outer);

  prologue (fp_outer);
  c_string_quote (str_inner, fp_outer);

  if (!in_server && tty) ansi_force_restore (fp_outer);
  fprintf (fp_outer, "\n");
  if (close_memstream (fp_outer) == -1)
    goto fail;

  if (!str_outer)
    goto fail;

  /* Send it to stderr as atomically as possible. */
  fputs (str_outer, stderr);

  errno = err; /* restore original value before return */
  return;

 fail:
  /* Try to emit what we can. */
  errno = err; /* so %m works */
  vfprintf (stderr, fs, args);
  fprintf (stderr, "\n");
  errno = err; /* restore original value before return */
}

/* Note: preserves the previous value of errno. */
NBDKIT_DLL_PUBLIC void
nbdkit_vdebug (const char *fs, va_list args)
{
  debug_common (false, fs, args);
}

/* Note: preserves the previous value of errno. */
NBDKIT_DLL_PUBLIC void
nbdkit_debug (const char *fs, ...)
{
  int err = errno;
  va_list args;

  va_start (args, fs);
  debug_common (false, fs, args);
  va_end (args);

  errno = err;
}

/* This variant of debug is used when debug is called from the server
 * code, via the debug() macro.
 *
 * Note: preserves the previous value of errno.
 */
void
debug_in_server (const char *fs, ...)
{
  int err = errno;
  va_list args;

  va_start (args, fs);
  debug_common (true, fs, args);
  va_end (args);

  errno = err;
}

struct hexdump_line {
  char str_offset[16+1]; /* The offset field */
  char hex[16*3+1];      /* Sixteen pairs of hex digits (or spaces) */
  char chars[16+1];      /* The printable chars (or spaces) */
  uint64_t offset;
};

static inline void
hexdump_reset_line (struct hexdump_line *line)
{
  snprintf (line->str_offset, sizeof line->str_offset, "%08" PRIx64,
            ROUND_DOWN (line->offset, 16));
  memset (line->hex, ' ', sizeof line->hex - 1);
  line->hex[sizeof line->hex - 1] = '\0';
  memset (line->chars, ' ', sizeof line->chars - 1);
  line->chars[sizeof line->chars - 1] = '\0';

}

static inline void
hexdump_set_byte (struct hexdump_line *line, size_t i, uint8_t b)
{
  sprintf (&line->hex[i*3], "%02x", b);
  line->hex[i*3+2] = ' ';
  line->chars[i] = ascii_isprint (b) ? b : '.';
}

/* Send the final string to nbdkit_debug. */
static inline void
hexdump_emit_debug (struct hexdump_line *line, const char *prefix)
{
  /* Start by splitting up the hex digits into two groups of 8. */
  line->hex[8*3-1] = '\0';
  nbdkit_debug ("%s%s: %s  %s |%s|",
                prefix ? : "",
                line->str_offset, line->hex, &line->hex[8*3], line->chars);
}

/* Usually this function would be part of server/public.c, but in this
 * case we want to use nbdkit_debug instead of debug_in_server.
 */
NBDKIT_DLL_PUBLIC void
nbdkit_debug_hexdump (const void *vbuf, size_t len,
                      const char *prefix, uint64_t start)
{
  if (!verbose)
    return;

  struct hexdump_line line = { .offset = start };
  const uint8_t *buf = vbuf;
  uint64_t skip;
  size_t i;

  /* Unaligned head. */
  if (! IS_ALIGNED (line.offset, 16)) {
    hexdump_reset_line (&line);
    skip = line.offset % 16;
    for (i = skip; i < 16 && len > 0; ++i) {
      hexdump_set_byte (&line, i, *buf);
      buf++;
      line.offset++;
      len--;
    }
    hexdump_emit_debug (&line, prefix);
  }

  /* Aligned body and unaligned tail. */
  while (len > 0) {
    assert (IS_ALIGNED (line.offset, 16));
    hexdump_reset_line (&line);
    for (i = 0; i < 16 && len > 0; ++i) {
      hexdump_set_byte (&line, i, *buf);
      buf++;
      line.offset++;
      len--;
    }
    hexdump_emit_debug (&line, prefix);
  }
}