1 files changed, 108 insertions, 0 deletions
diff --git a/fw/8b10b_test_encode.c b/fw/8b10b_test_encode.c
new file mode 100644
index 0000000..2ba75d9
--- /dev/null
+++ b/fw/8b10b_test_encode.c
@@ -0,0 +1,108 @@
+
+#include <stdio.h>
+#include <string.h>
+
+#include "8b10b.h"
+
+static const char * const rc_names[] = {
+    [K28_0] = "K.28.0",
+    [K28_1] = "K.28.1",
+    [K28_2] = "K.28.2",
+    [K28_3] = "K.28.3",
+    [K28_4] = "K.28.4",
+    [K28_5] = "K.28.5",
+    [K28_6] = "K.28.6",
+    [K28_7] = "K.28.7",
+    [K23_7] = "K.23.7",
+    [K27_7] = "K.27.7",
+    [K29_7] = "K.29.7",
+    [K30_7] = "K.30.7",
+};
+
+int hex_to_uint(const char *s, size_t len) {
+    if (len > 7)
+        return -2;
+
+    int acc = 0;
+    for (int i=0; i<len; i++) {
+        int digit = s[i];
+        if ('0' <= digit && digit <= '9')
+            digit -= '0';
+        else if ('a' <= digit && digit <= 'f')
+            digit -= 'a' - 0xa;
+        else if ('A' <= digit && digit <= 'F')
+            digit -= 'A' - 0xA;
+        else return -1;
+        acc = acc << 4 | digit;
+    }
+
+    return acc;
+}
+
+int main(void) {
+    struct state_8b10b_enc st;
+    xfr_8b10b_encode_reset(&st);
+
+    int c;
+    int comment = 0;
+    char parse_buf[32];
+    int parse_buf_pos = 0;
+    while ((c=fgetc(stdin)) != EOF) {
+        if (comment) {
+            if (c == '\n')
+                comment = 0;
+            printf("%c", c);
+            continue;
+        }
+
+        if (c == '#') {
+            comment = 1;
+            printf("%c", c);
+            continue;
+        }
+
+        if (c != '\r' && c != ' ' && c != '\t' && c != '\n') {
+            parse_buf[parse_buf_pos++] = (char)c;
+            if (parse_buf_pos == sizeof(parse_buf)) {
+                parse_buf[sizeof(parse_buf)-1] = '\0';
+                fprintf(stderr, "Parse error: Token \"%s[...]\" too long. Exiting.\n", parse_buf);
+                return 1;
+            }
+            continue;
+        }
+
+        if (parse_buf_pos == 0)
+            continue;
+
+        int data = 0;
+        for (int i=1; i<sizeof(rc_names)/sizeof(rc_names[0]); i++) {
+            if (!strncmp(rc_names[i], parse_buf, parse_buf_pos)) {
+                data = -i;
+                break;
+            }
+        }
+
+        if (!data) {
+            data = hex_to_uint(parse_buf, parse_buf_pos);
+            if (data < 0) {
+                parse_buf[parse_buf_pos] = '\0';
+                fprintf(stderr, "Invalid hex number: \"%s\"\n", parse_buf);
+                return 1;
+            }
+        }
+
+        parse_buf_pos = 0; /* reset for next token */
+
+        int encoded = xfr_8b10b_encode(&st, data);
+        if (encoded < 0) {
+            fprintf(stderr, "Invalid argument error encoding\n");
+            return 2;
+        }
+
+        for (int i=0; i<10; i++)
+            printf("%c", (encoded & (1<<(9-i))) ? '1' : '0');
+
+        printf("%c", c); /* print whitespace character */
+    }
+}
+