/* -*- c -*- */
/*
 * Copyright 2007 Free Software Foundation, Inc.
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

/*
 * Based on code from the SDCC z80 library ;)
 */

#include <stdarg.h>
#include <stdio.h>
#include <hal_io.h>		/* FIXME refactor into stdio */

#define PUTCHAR(x) hal_putc(x)


static void 
_printn(unsigned u, unsigned base, char issigned)
{
  const char *_hex = "0123456789ABCDEF";
  if (issigned && ((int)u < 0)) {
    PUTCHAR('-');
    u = (unsigned)-((int)u);
  }
  if (u >= base)
    _printn(u/base, base, 0);
  PUTCHAR(_hex[u%base]);
}

static void 
_printf(const char *format, va_list va)
{
  while (*format) {
    if (*format != '%')
      PUTCHAR(*format);
    else {
      switch (*++format) {
      case 0:			/* hit end of format string */
	return;
      case 'c':
	{
	  char c = (char)va_arg(va, int);
	  PUTCHAR(c);
	  break;
	}
      case 'u':
	{
	  unsigned u = va_arg(va, unsigned);
	  _printn(u, 10, 0);
	  break;
	}
      case 'd':
	{
	  unsigned u = va_arg(va, unsigned);
	  _printn(u, 10, 1);
	  break;
	}
      case 'x':
      case 'p':
	{
	  unsigned u = va_arg(va, unsigned);
	  _printn(u, 16, 0);
	  break;
	}
      case 's':
	{
	  char *s = va_arg(va, char *);
	  while (*s) {
	    PUTCHAR(*s);
	    s++;
	  }
	  break;
	}
      }
    }
    format++;
  }
}

#if 0
static void 
_char_emitter(char c, void *pData __attribute__((unused)))
{
  hal_putc(c);
}
#endif

int 
printf(const char *format, ...)
{
  va_list va;
  va_start(va, format);

  _printf(format, va);

  // wrong return value...
  return 0;
}


#if 0

// Totally dangerous.  Don't use
static void 
_buf_emitter(char c, void *pData)
{
  *((*((char **)pData)))++ = c;
}

int sprintf(char *pInto, const char *format, ...)
{
  va_list va;
  va_start(va, format);

  _printf(format, _buf_emitter, &pInto, va);
  *pInto++ = '\0';

  // FIXME wrong return value
  return 0;
}
#endif