/*
 * vim:ts=4:sw=4:expandtab
 */
#ifndef HEX_CONVERSION_H
#define HEX_CONVERSION_H

#include <stdlib.h>
#include <string.h>
#include <ctype.h>

#ifdef DEBUGBUILD
#include "output.h"
#endif

#define ishex_macro(c) ((c>='0' && c <= '9') || (c>='A' && c <= 'F') || (c>='a' && c <= 'f'))

int convert_line(char *s);
int ishex(char c);
char *convert_to_binary(char *hex, char *out);
char *convert_from_binary(char *bin, size_t l, char *out);

/* short inline functions are fine in header */
inline int convert_line(char *s) {
    size_t i = 0, l = 0;
    if (s == NULL)
        return -1;
    l=strlen(s);
    for (i=0; i<l; i++) {
        s[i] = (char)toupper(s[i]);
        if ((s[i] == '\r' && (l-i<3)) || (s[i] == '\n' && i==l-1)) {
            s[i] = '\0';
            break;
        }
    }
    return 0;
}

inline int ishex(char c) {
    if ((c>='0' && c <= '9') || (c>='A' && c <= 'F') || (c>='a' && c <= 'f')) {
        return 1;
    }
    return 0;
};

inline char *convert_to_binary(char *hex, char *out) {
    char tmp[3] = {0,0,0};
    size_t length, i;
    if (hex == NULL) return NULL;
    length=strlen(hex);
    if ( (length==0) || (length%2 == 1)) return NULL;
    for (i=0; i<length; i++) {
        if ( ! ishex_macro(hex[i]) ) {
#ifdef DEBUGBUILD
            LOGERR("Incompatible string '%s'\n", hex);
#endif
            return NULL;
        }
    }
    if (out == NULL && ((out = calloc((length/2),sizeof(char))) == NULL)) {
#ifdef DEBUGBUILD
        LOGERR("ERROR: Failed to allocate %d bytes\n", (length/2));
#endif
        return NULL;
    }
    for (i=0;i<length;i+=2) {
        tmp[0] = hex[i];
        tmp[1] = hex[i+1];
        out[i/2] = (char) strtol(tmp, NULL, 16);
    }
    return out;
}

/* Use a large buffer and complex method, as with a simple
 * way there regularly were corrupt results with gcc -O2. */
inline char *convert_from_binary(char *bin, size_t l, char *out) {
    char tmp[24];
    size_t i,pos;
    if (bin == NULL || l == 0) return NULL;
    if (out == NULL && (out = calloc(((l*2)+1),sizeof(char))) == NULL) {
#ifdef DEBUGBUILD
        LOGERR("ERROR: Failed to allocate %lu bytes\n", ((l*2)+1));
#endif
        return NULL;
    }
    for (i=0; i<l; i++) {
        /* Keep in mind this format is not only two characters. */
        sprintf(tmp, "%02X", (unsigned char)bin[i]);
        pos=strlen(tmp);
        out[i*2] = tmp[pos-2];
        out[(i*2)+1] = tmp[pos-1];
    }
    return out;
}

#endif