util.c

Embeded bootloader (rrload by ridgerun) for TI linux based platform v5.36

/*
 * File: util.c
 *
 * An implementation of a utility which exposes the util.h interface. Please
 * see util.h for more info.
 *
 * See Also
 *   util.h
 *
 * Copyright (C) 2002 RidgeRun, Inc.
 * Author: RidgeRun, Inc  <[e-mail]>
 *
 *  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 2 of the  License, or (at your
 *  option) any later version.
 *
 *  THIS  SOFTWARE  IS  PROVIDED  ``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.
 *
 *  You should have received a copy of the  GNU General Public License along
 *  with this program; if not, write  to the Free Software Foundation, Inc.,
 *  675 Mass Ave, Cambridge, MA 02139, USA.
 *
 * Please report all bugs/problems to the author or <[e-mail]>
 *
 * key: RRGPLCR (do not remove)
 *
 */

#include "memconfig.h"
#include "types.h"
#include "util.h"
#include "io.h"

static const unsigned char hextable[256] = {
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
    0,   1,   2,   3,   4,   5,   6,   7,   8,   9, 255, 255, 255, 255, 255, 255,
  255,  10,  11,  12,  13,  14,  15, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255,  10,  11,  12,  13,  14,  15, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
  255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
};

static char *do_sprintf(char *buf, const char *fmt, ...);

/******************************
 Routine:
 Description:
 ******************************/
unsigned char util_ascii_to_bin(unsigned char c)
{
  return hextable[c];
}

/******************************
 Routine: similar to hexstrtobyte
 Description:
   Incoming string is assumed to be a hex numeric string
   (without the 0x prefix) whos converted value will fit within
   an integer.
 ******************************/
int util_hexstrtoint(char *val, int *ret)
{
        *ret = 0;
        while ((*val != '\0') && (*val != '\r')) {
                int d;
                if ((*val >= '0') && (*val <= '9'))
                        d = *val - '0';
                else if ((*val >= 'a') && (*val <= 'f'))
                        d = *val - 'a' + 10;
                else if ((*val >= 'A') && (*val <= 'F'))
                        d = *val - 'A' + 10;
                else {
                        util_printf("Bad digit '%c'\n", *val);
                        return -1;
                }
                *ret = *ret << 4;
                *ret += d;
                val++;
        }
        return 0;
}


/******************************
 Routine:
 Description:
   Incoming string is assumed to be a hex numeric string
   (without the 0x prefix) whos converted value will fit within
   a single byte.  example "1", "ff", "7d", "22", etc.
 ******************************/
unsigned char util_hexstrtobyte(char *str)
{
  unsigned short retval;
  int len;
  retval = 0;
  len = util_strlen(str);
  if (2 == len) {
    retval += (unsigned short)(util_ascii_to_bin(str[0])*0x10);
    retval += (unsigned short)(util_ascii_to_bin(str[1]));
  } else if (1 == len) {
    retval += (unsigned short)(util_ascii_to_bin(str[0]));
  } else {
    SYSTEM_FATAL("Logic Error");
  }
  if (retval > 0x00FF) SYSTEM_FATAL("Logic Error");
  return (unsigned char)retval;
}

/******************************
 Routine:
 Description:
   Incoming string is assumed to be a numeric dec string
   whos converted value will fit withing a single int.
   example "1", "255", "125", "34", "65535", etc.
 ******************************/
unsigned int util_decstrtoint(char *str)
{
  unsigned int retval;
  int len,i, mul=1;
  retval = 0;
  len = util_strlen(str);
  for (i=1;i<=len;i++)
  {
    retval += (unsigned int)(util_ascii_to_bin(str[len - i]) * mul);
    mul *= 10;
  }
  if (retval > 0xFFFFFFFF) SYSTEM_FATAL("Logic Error");
  return retval;
}

/******************************
 Routine:
 Description:
   Incoming string is assumed to be a numeric dec string
   whos converted value will fit withing a single byte.
   example "1", "255", "125", "34", etc.
 ******************************/
unsigned char util_decstrtobyte(char *str)
{
  unsigned short retval;
  int len;
  retval = 0;
  len = util_strlen(str);
  if (3 == len) {
    retval += (unsigned short)(util_ascii_to_bin(str[0]) * 100);
    retval += (unsigned short)(util_ascii_to_bin(str[1]) * 10);
    retval += (unsigned short)(util_ascii_to_bin(str[2]) * 1);
  } else if (2 == len) {
    retval += (unsigned short)(util_ascii_to_bin(str[0]) * 10);
    retval += (unsigned short)(util_ascii_to_bin(str[1]) * 1);
  } else if (1 == len) {
    retval += (unsigned short)(util_ascii_to_bin(str[0]) * 1);
  }
  if (retval > 0x00FF) SYSTEM_FATAL("Logic Error");
  return (unsigned char)retval;
}

/******************************
 Routine:
 Description:
   Input string is expected to be standard IP format;
   x.x.x.x, where x can be up to three numeric decimal characters.
   example. "128.34.130.9"
 ******************************/
unsigned long util_IPstr_to_num(char *IP)
{
  // Example IP: 1.2.3.4 (7 chars)
  // Example IP: 100.200.300.400 (15 chars)
  #define MIN_IP 7
  #define MAX_IP 15
  char str[MAX_IP+1];
  unsigned long retval;
  unsigned char bval;
  unsigned char *start;
  unsigned char *end;
  bval = retval = 0;
  if (util_strlen(IP) < MIN_IP) SYSTEM_FATAL("IP format error");
  if (util_strlen(IP) > MAX_IP) SYSTEM_FATAL("IP format error");
  util_strcpy(str,IP); // get a local writable copy.
  // Byte#1 MSB
  end = str;
  start = end;
  while (*end != '.') end++;
  *end = 0; // replace the '.' with a 0 to terminate the string.
  bval = util_decstrtobyte(start);
  retval = retval | bval<<24;
  // Byte#2
  end++;
  start = end;
  while (*end != '.') end++;
  *end = 0;
  bval = util_decstrtobyte(start);
  retval =  retval | bval<<16;
  // Byte#3
  end++;
  start = end;
  while (*end != '.') end++;
  *end = 0;
  bval = util_decstrtobyte(start);
  retval =  retval | bval<<8;
  // Byte#4 LSB
  end++;
  start = end;
  bval = util_decstrtobyte(start);
  retval =  retval | bval;
  return retval;
}

/******************************
 Routine:
 Description:
   Input string is expected to be in standard MAC format;
   x:x:x:x:x:x, where x can be up to two numeric hex characters.
   example. "ff:0:e0:10:c:22" This call will convert the incoming
   string into a series of numeric values which are loaded into
   the callers supplied array; mac_array[0] through mac_array[5].
 ******************************/
void util_fill_MAC(unsigned char *mac_array, char *MAC_str)
{
  // example MAC: 1:2:3:4:5:6 (11 chars).
  // example MAC: 10:20:30:40:50:60 (17 chars).
  #define MIN_MAC 11
  #define MAX_MAC 17
  char str[MAX_MAC+1];
  int i;
  unsigned char bval;
  unsigned char *start;
  unsigned char *end;
  bval = 0;
  if (util_strlen(MAC_str) < MIN_MAC) SYSTEM_FATAL("MAC str format Error");
  if (util_strlen(MAC_str) > MAX_MAC) SYSTEM_FATAL("MAC str format Error");
  util_strcpy(str,MAC_str); // get a local writable copy.
  end = str;
  start = end;
  for (i=0; i<6; i++) {
    if (i<5) {
      while (*end != ':') end++;
      *end = 0; // replace the ':' with a 0 to terminate the string.
    }
    bval = util_hexstrtobyte(start);
    mac_array[i] = bval;
    end++;
    start = end;
  }
}

/******************************
 Routine:
 Description:
  Format codes
    %d - decimal
    %i - decimal
    %b - 1 byte val (2 ascii hex digits)
    %x - 2 byte val (4 ascii hex digits)
    %X - 4 byte val (8 ascii hex digits)
    %s - An ASCII string
    %c - An ASCII char
    %I - Internet address (x.x.x.x)
******************************/
static const char hex[]="0123456789ABCDEF";
static char *do_printf(char *buf, const char *fmt, const int *dp)
{
  register char *p;
  char tmp[16];
  while (*fmt) {