#include "ByteConvert.hpp"

namespace ByteConvert {

char valToHex(uint8_t val) {

if ((val & 0x0f) < 10)

return ('0' + val);

else

return ('a' + (val - 10));

}

uint8_t hexToVal(char c) {

if (c >= 'a')

return (15 - ('f' - c));

else

return (9 - ('9' - c));

}

std::string byteToHexString(uint8_t b) {

std::string buffer = "";

buffer += valToHex(b & 0x0f);

b >>= 4;

buffer = valToHex(b & 0x0f) + buffer;

return buffer;

}

uint8_t hexStringToByte(std::string block) {

if (block.length() != 2)

return 0x00;

return 16*hexToVal(block.at(0))+hexToVal(block.at(1));

}

std::string arrayToString(size_t size,uint8_t *src) {

std::string buffer = "";

for (size_t i = 0;i < (size);i++)

buffer += byteToHexString(src[i]);

return buffer;

}

uint8_t* stringToArray(size_t &size,std::string src) {

// Length of src must be odd !!

if (src.length() % 2 == 1)

src = "0" + src;

size = src.length()/2;

uint8_t *dst = new uint8_t[size]; // Allocate memory space

std::string buff = "";

for (size_t i = 0;i < (size);i++) {

buff = src.at(i*2);

buff += src.at(i*2+1);

dst[i] = hexStringToByte(buff);

}

return dst;

}

}