67 lines
1.8 KiB
C
67 lines
1.8 KiB
C
#include "hex.h"
|
|
|
|
static uint8_t hex_table[256] = {0};
|
|
static char hex_upper_table[16] = { '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'A', 'B', 'C', 'D', 'E', 'F', };
|
|
static char hex_lower_table[16] = { '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'a', 'b', 'c', 'd', 'e', 'f', };
|
|
|
|
void hex_init() {
|
|
for (int i = '0'; i <= '9'; i++) {
|
|
hex_table[i] = i - '0';
|
|
}
|
|
for (int i = 'a'; i <= 'f'; i++) {
|
|
hex_table[i] = 10 + i - 'a';
|
|
}
|
|
for (int i = 'A'; i <= 'F'; i++) {
|
|
hex_table[i] = 10 + i - 'A';
|
|
}
|
|
}
|
|
|
|
void hex_to_bin(uint8_t *out, const char *in, size_t bytes) {
|
|
const uint8_t *in2 = (uint8_t *) in;
|
|
for (size_t i = 0, j = 0; i < bytes; i++, j += 2) {
|
|
out[i] = (hex_table[in2[j]] << 4) | hex_table[in2[j + 1]];
|
|
}
|
|
}
|
|
|
|
uint64_t hex_to_int(const char *in, size_t bytes) {
|
|
const uint8_t *in2 = (uint8_t *) in;
|
|
uint64_t ret = 0;
|
|
bytes *= 2;
|
|
for (size_t i = 0; i < bytes; i++) {
|
|
ret <<= 4;
|
|
ret |= hex_table[in2[i]];
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static void hex_from_bin(char *out, const uint8_t *in, size_t bytes, char table[]) {
|
|
for (size_t i = 0, j = 0; i < bytes; i++, j += 2) {
|
|
out[j] = table[in[i] >> 4];
|
|
out[j + 1] = table[in[i] & 0xf];
|
|
}
|
|
}
|
|
|
|
static void hex_from_int(char *out, uint64_t in, size_t bytes, char table[]) {
|
|
bytes *= 2;
|
|
for (int o = bytes - 1; o >= 0; o--) {
|
|
out[o] = table[in & 0xf];
|
|
in >>= 4;
|
|
}
|
|
}
|
|
|
|
void hex_from_bin_upper(char *out, const uint8_t *in, size_t bytes) {
|
|
hex_from_bin(out, in, bytes, hex_upper_table);
|
|
}
|
|
|
|
void hex_from_bin_lower(char *out, const uint8_t *in, size_t bytes) {
|
|
hex_from_bin(out, in, bytes, hex_lower_table);
|
|
}
|
|
|
|
void hex_from_int_upper(char *out, uint64_t in, size_t bytes) {
|
|
hex_from_int(out, in, bytes, hex_upper_table);
|
|
}
|
|
|
|
void hex_from_int_lower(char *out, uint64_t in, size_t bytes) {
|
|
hex_from_int(out, in, bytes, hex_lower_table);
|
|
}
|