ascii_parser.c

#include "main-header.h"
// #include "bare-metal.h"
 
int atoi(const char *s) {
  int res = 0;
 
  if (s == NULL) {
    return 0;
  }
  int pos = 0;
 
  while (s[pos] != 0) {
    int z = ascii_parse_num(s[pos]);
    if (z == -1) {
      return res;
    }
    res = res * 10;
    res = res + z;
    pos++;
  }
  return res;
}
 
byte atoh(const char *s) {
  int x, y;
 
  x = charToHex(s[0]);
  if (x == -1) {
    return 0;
  }
  y = charToHex(s[1]);
  if (y == -1) {
    return 0;
  }
  int r = (x << 4) + y;
 
  return (byte)r;
}
 
 
int ascii_parse_num(int b) {
  if ((b < '0') || (b > '9')) {
    return -1;
  }
  return b - '0';
}
int ascii_parse_int(const byte *buf, int size, int *const newpos) {
  int res = 0;
  int consumed = 0;
 
  if (size <= 0) {
    *newpos = 0;
    CNWDEBUG("attempt to parse ascii int with size %i\r\n", size);
    return -1;
  }
  while (consumed < size) {
    int b = ascii_parse_num(buf[consumed]);
    if (b < 0) {
      *newpos = consumed;
      return res;
    }
    res = res * 10 + b;
    consumed++;
  }
  *newpos = consumed;
  return res;
}
long ascii_parse_hex(const byte *buf, int size, int *newpos) {
  int consumed = 0;
  long res = 0;
 
  if (newpos != NULL) {
    *newpos = -1;
  }
  if (size <= 0) {
    if (newpos != NULL) {
      *newpos = 0;
    }
    CNWDEBUG("attempt to parse ascii hex with size %i\r\n", size);
    return -1;
  }
  while (consumed < size) {
    int t = charToHex(buf[consumed]);
    if (t < 0) {
      if (newpos != NULL) {
        *newpos = consumed;
      }
      //      CNWDEBUG("1 Hex parser: %li [%i,%i] (%s)\r\n",res,consumed,t,(char *)&buf[consumed]);
      return res;
    }
    res = (res << 4) | t;
    consumed++;
  }
  //CNWDEBUG("2 Hex parser: %li [%i] (%s)\r\n",res,consumed,(char *)&buf[consumed]);
  if (newpos != NULL) {
    *newpos = consumed;
  }
  return res;
}