1 files changed, 96 insertions, 0 deletions
diff --git a/include/hex_conversion.h b/include/hex_conversion.h
new file mode 100644
index 0000000..b31216d
--- /dev/null
+++ b/include/hex_conversion.h
@@ -0,0 +1,96 @@
+/*
+ * 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] = 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
+