/*
*Copyright(c)2014, Jeffrey Lee
*Allrightsreserved.
*
 * 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.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS 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 THE COPYRIGHT HOLDER 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 <stdio.h>
#include <stdarg.h>
#include <stdbool.h>
#include <stdlib.h>
#include <kernel.h>
#include <swis.h>

#include <oslib/syslog.h>

#include "debug.h"
#include "header.h"

#define SysLog

static bool debug_on = false;

void debug_init()
{
  /* Check vncserv_debug system variable */
  char *var = getenv("vncserv_debug");
  debug_on = (var && atoi(var));
}

void debug_finalise()
{
}

void dprintf(const char* fmt, ...)
{
  if (!debug_on)
    return;

  char buf[256];
  va_list a;
  va_start(a,fmt);
  vsnprintf(buf, sizeof(buf), fmt, a);
  va_end(a);

#ifdef SysLog
  if (!xsyslog_irq_mode(true))
  {
    xsyslog_log_message(Module_Title, buf, 64);
    xsyslog_irq_mode(false);
  }
#else
  static void (*dadwritec)(char) = NULL;
  if (!dadwritec)
  {
    _swix(0x531c0,_OUT(0),&dadwritec);
  }
  if (dadwritec)
  {
    char *c = buf;
    while(*c)
    {
      dadwritec(*c++);
    }
  }
#endif
}
