//==========================================================================
//
//      utils.c
//
//      Monitor utilities.
//
//==========================================================================
//####COPYRIGHTBEGIN####
//                                                                          
// -------------------------------------------                              
// The contents of this file are subject to the Red Hat eCos Public License 
// Version 1.1 (the "License"); you may not use this file except in         
// compliance with the License.  You may obtain a copy of the License at    
// http://www.redhat.com/                                                   
//                                                                          
// Software distributed under the License is distributed on an "AS IS"      
// basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.  See the 
// License for the specific language governing rights and limitations under 
// the License.                                                             
//                                                                          
// The Original Code is eCos - Embedded Configurable Operating System,      
// released September 30, 1998.                                             
//                                                                          
// The Initial Developer of the Original Code is Red Hat.                   
// Portions created by Red Hat are                                          
// Copyright (C) 1998, 1999, 2000 Red Hat, Inc.                             
// All Rights Reserved.                                                     
// -------------------------------------------                              
//                                                                          
//####COPYRIGHTEND####
//==========================================================================
//#####DESCRIPTIONBEGIN####
//
// Author(s):    
// Contributors: gthomas
// Date:         1999-10-20
// Purpose:      Monitor utilities.
// Description:  
//               
//
//####DESCRIPTIONEND####
//
//=========================================================================

#include <limits.h>
#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#ifdef HAVE_BSP
#include <bsp/bsp.h>
#include <bsp/cpu.h>
#include <bsp/hex-utils.h>
#endif
#include "monitor.h"
#include "tservice.h"

#if USE_CYGMON_PROTOTYPES
/* Use common prototypes */
/* Some of the composed board.h files compose these
   prototypes redundently, but if they dont,
   these are the common definitions */
#include "fmt_util.h"   /* Interface to string formatting utilities */
#include "generic-stub.h" /* from libstub */
#endif /* USE_CYGMON_PROTOTYPES */

int switch_to_stub_flag = 0;

/* Input routine for the line editor. */
int
input_char (void)
{
  int i = xgetchar ();
  if (i == '$')
    {
      xungetchar ('$');
      switch_to_stub_flag = 1;
      i = '\n';
    }
  return i;
}


static char tohex_array[16] = {'0', '1', '2', '3', '4', '5', '6', '7',
			       '8', '9', 'a', 'b', 'c', 'd', 'e', 'f'};

#define tohex(X) (tohex_array[(X) & 15])

#ifdef HAVE_BSP
#define fromhex __hex
#else
static int
fromhex (a)
{
  int number = -1;

  if (a >= '0' && a <= '9')
    number = a - '0';
  else if (a >= 'a' && a <= 'f')
    number = a - 'a' + 10;
  else if (a >= 'A' && a <= 'F')
    number = a - 'A' + 10;
  else 
    xprintf ("Invalid hex digit %c", a);

  return number;
}
#endif


static unsigned long long
str2ull (char *str, int base)
{
  unsigned long long l = 0;

  if (str[0] == '0' && str[1] == 'x')
    {
      str += 2 ;
      base = 16 ;
    }

  while (*str != '\0')
    {
      if (*str == '.')
	str++;
      else
	l = (l * base) + fromhex(*str++);
    }

  return l;
}


/* Converts a string to a long, base is the assumed base of the string */

target_register_t
str2int (char *str, int base)
{
  return str2ull(str, base);
}


/* Converts a string to a float, input is a raw integer string
 * of the given assumed base. */
#if HAVE_FLOAT_REGS
static float
str2float (char *str, int base)
{
  float f;
  unsigned long long ull = str2ull(str, base);

  switch (sizeof(float))
    {
      case sizeof(unsigned int):
	*((unsigned int *)&f) = ull;
	break;
#if __LONG_MAX__ != __INT_MAX__
      case sizeof(unsigned long):
	*((unsigned long *)&f) = ull;
	break;
#endif
#if __LONG_LONG_MAX__ != __LONG_MAX__
      case sizeof(unsigned long long):
	*((unsigned long long *)&f) = ull;
	break;
#endif
      default:
	f = 0.0;
	break;
    }

  return f;
}
#endif


/* Converts a string to a double, input is a raw integer string
 * of the given assumed base. */
#if HAVE_DOUBLE_REGS
static double
str2double (char *str, int base)
{
  double d;

  switch (sizeof(double))
    {
      case sizeof(unsigned int):
	*((unsigned int *)&d) = str2ull(str, base);
	break;
#if __LONG_MAX__ != __INT_MAX__
      case sizeof(unsigned long):
	*((unsigned long *)&d) = str2ull(str, base);
	break;
#endif
#if __LONG_LONG_MAX__ != __LONG_MAX__
      case sizeof(unsigned long long):
	*((unsigned long long *)&d) = str2ull(str, base);
	break;
#endif
      default:
	d = 0.0;
	break;
    }
  return d;
}
#endif

target_register_t
str2intlen (char *str, int base, int len)
{
  target_register_t number = 0;

  while ((len--) > 0 && *str != '\0')
    number = number * base + fromhex (*(str++));

  return number;
}

int
hex2bytes (char *str, char *dest, int maxsize)
{
  int i;
  char *ptr;

  for (i = 0; i < maxsize; i++)
    dest[i] = 0;
  maxsize--;
  ptr = str + strlen(str) - 1;
  while (maxsize >= 0 && ptr >= str)
    {
      dest [maxsize] = fromhex(*ptr);
      ptr--;
      if (ptr >= str)
	{
	  dest [maxsize--] |= fromhex(*ptr) * 16;
	  ptr--;
	}
    }
  return 0;
}


/* Converts an unsigned long long to an ASCII string, adding leading
   zeroes to pad space up to numdigs. */
static int use_dots = 1;

#define MAX_NUM_DIGS 51

static char *
ull2str (unsigned long long number, int base, int numdigs)
{
  static char string[MAX_NUM_DIGS+1];
  int dots, i;
  char *ptr = string + MAX_NUM_DIGS;

  dots = (use_dots && base == 16);

  *(ptr--) = '\0';
  *(ptr--) = tohex (number % base);
  i = 1;
  number = number / base;

  while (number != 0)
    {
      if (dots && (i % 4) == 0)
	*(ptr--) = '.';
      *(ptr--) = tohex (number % base);
      i++;
      number = number / base;
    }

  if (numdigs == 0)
    {
      numdigs = i;
    }
  else
    {
      while(i < numdigs)
	{
	  if (dots && (i % 4) == 0)
	    *(ptr--) = '.';
	  *(ptr--) = '0';
	  i++;
	}
    }
  return ptr + 1;
}


char *
int2str (target_register_t number, int base, int numdigs)
{
  return ull2str((unsigned long long)number, base, numdigs);
}

#if HAVE_FLOAT_REGS
static char *
float2str(float f)
{
  switch(sizeof(float))
    {
      case sizeof(unsigned int):
	return ull2str(*((unsigned int *)&f), 16, sizeof(float) * 2);
	break;
#if __LONG_MAX__ != __INT_MAX__
      case sizeof(unsigned long):
	return ull2str(*((unsigned long *)&f), 16, sizeof(float) * 2);
	break;
#endif
#if __LONG_LONG_MAX__ != __LONG_MAX__
      case sizeof(unsigned long long):
	return ull2str(*((unsigned long long *)&f), 16, sizeof(float) * 2);
	break;
#endif
    }
  return "....fixme...";
}
#endif

#if HAVE_DOUBLE_REGS
static char *
doudble2str(double d)
{
  switch(sizeof(double))
    {
      case sizeof(unsigned int):
	return ull2str(*((unsigned int *)&d), 16, sizeof(double) * 2);
	break;
#if __LONG_MAX__ != __INT_MAX__
      case sizeof(unsigned long):
	return ull2str(*((unsigned long *)&d), 16, sizeof(double) * 2);
	break;
#endif
#if __LONG_LONG_MAX__ != __LONG_MAX__
      case sizeof(unsigned long long):
	return ull2str(*((unsigned long long *)&d), 16, sizeof(double) * 2);
	break;
#endif
    }
  return "....fixme...";
}
#endif

#ifndef NO_MALLOC
char *
strdup(const char *str)
{
  char *x = malloc (strlen (str) + 1);
  if (x != NULL)
    strcpy (x, str);
  return x;
}
#endif


target_register_t
get_pc(void)
{
#ifdef HAVE_BSP
    target_regval_t pc;

    pc = get_register(REG_PC);

    return pc.i;
#else
    return get_register(PC);
#endif
}


#ifdef HAVE_BSP
static int
get_register_type(regnames_t which)
{
    int i;

    for (i = 0; regtab[i].registername != NULL; i++)
      if (regtab[i].registernumber == which)
	return regtab[i].registertype;
    return REGTYPE_INT;
}
#endif


char *
get_register_str (regnames_t which, int detail)
{
#ifdef SPECIAL_REG_OUTPUT
  char *res;

  if ((res = SPECIAL_REG_OUTPUT (which, detail)) != NULL)
    {
      return res;
    }
#endif
#ifdef HAVE_BSP
  {
    target_regval_t reg;

    reg = get_register (which);
    switch (get_register_type (which))
      {
	case REGTYPE_INT:
	  return ull2str (reg.i, 16, sizeof(reg.i) * 2);
	  break;
#if HAVE_FLOAT_REGS
	case REGTYPE_FLOAT:
	  return float2str (reg.f);
	  break;
#endif
#if HAVE_DOUBLE_REGS
	case REGTYPE_DOUBLE:
	  return double2str (reg.d);
	  break;
#endif
      }
    return "...help...";
  }
#else
  return int2str (get_register (which), 16, sizeof (target_register_t) * 2);
#endif
}


void
store_register (regnames_t which, char *string)
{
#ifdef SPECIAL_REG_STORE
  if (SPECIAL_REG_STORE(which, string))
    return;
#endif
#ifdef HAVE_BSP
  {
    target_regval_t reg;

    switch (get_register_type(which))
      {
	case REGTYPE_INT:
	  reg.i = str2int (string, 16);
	  break;
#if HAVE_FLOAT_REGS
	case REGTYPE_FLOAT:
	  reg.f = str2float (string, 16);
	  break;
#endif
#if HAVE_DOUBLE_REGS
	case REGTYPE_DOUBLE:
	  reg.d = str2double (string, 16);
	  break;
#endif
      }
    put_register (which, reg);
  }
#else
  put_register (which, str2int (string, 16));
#endif
}