cp/nucleus/util.c

   1 /*
   2  * (C) Copyright 2007-2011  Josef 'Jeff' Sipek <jeffpc@josefsipek.net>
   3  *
   4  * This file is released under the GPLv2.  See the COPYING file for more
   5  * details.
   6  */
   7
   8 #include <slab.h>
   9 #include <util.h>
  10
  11 char *strdup(char *s, int flags)
  12 {
  13         char *d;
  14         int len;
  15
  16         for(d=s; *d; d++)
  17                 ;
  18
  19         len = d - s;
  20
  21         d = malloc(sizeof(char)*len, flags);
  22         if (!d)
  23                 return NULL;
  24
  25         memcpy(d, s, len*sizeof(char));
  26
  27         return d;
  28 }
  29
  30 int hex(char *a, char *b, u64 *out)
  31 {
  32         u64 val;
  33         char c;
  34
  35         if (a>=b)
  36                 return 1;
  37
  38         val = 0;
  39
  40         while(a<b) {
  41                 c = *a;
  42
  43                 if ((c >= '0') && (c <= '9'))
  44                         val = (val << 4) | (*a - '0');
  45                 else if ((c >= 'A') && (c <= 'F'))
  46                         val = (val << 4) | (*a - 'A' + 10);
  47                 else if ((c >= 'a') && (c <= 'f'))
  48                         val = (val << 4) | (*a - 'a' + 10);
  49                 else
  50                         return 1;
  51
  52                 a++;
  53         }
  54
  55         *out = val;
  56
  57         return 0;
  58 }
  59
  60 int bcd2dec(u64 val, u64 *out)
  61 {
  62         u64 v;
  63         u64 scale;
  64
  65         for(v=0,scale=1; val; scale*=10, val>>=4) {
  66                 u64 x = val & 0xf;
  67
  68                 if (x>=10)
  69                         return 1;
  70
  71                 v += (x*scale);
  72         }
  73
  74         *out = v;
  75
  76         return 0;
  77 }