From 9fb0f4d2becd19b6ef278ebe01159a2a3899abea Mon Sep 17 00:00:00 2001
From: Michael Gernoth <michael@gernoth.net>
Date: Sat, 13 Jul 2013 13:28:08 +0200
Subject: [PATCH] add non-working firmware-flasher

---
 .gitignore       |   3 ++
 Makefile         |   7 ++-
 flash-hmcfgusb.c | 129 +++++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 137 insertions(+), 2 deletions(-)
 create mode 100644 flash-hmcfgusb.c

diff --git a/.gitignore b/.gitignore
index 097ebd3..b372796 100644
--- a/.gitignore
+++ b/.gitignore
@@ -1,3 +1,6 @@
+flash-hmcfgusb
+flash-hmcfgusb.d
+flash-hmcfgusb.o
 hmcfgusb.d
 hmcfgusb.o
 hmland
diff --git a/Makefile b/Makefile
index f443d2c..7cadd48 100644
--- a/Makefile
+++ b/Makefile
@@ -5,8 +5,9 @@ CC=gcc
 
 HMLAN_OBJS=hmcfgusb.o hmland.o
 HMSNIFF_OBJS=hmcfgusb.o hmsniff.o
+FLASH_HMCFGUSB_OBJS=hmcfgusb.o flash-hmcfgusb.o
 
-OBJS=$(HMLAN_OBJS) $(HMSNIFF_OBJS)
+OBJS=$(HMLAN_OBJS) $(HMSNIFF_OBJS) $(FLASH_HMCFGUSB_OBJS)
 
 all: hmland hmsniff
 
@@ -17,7 +18,9 @@ hmland: $(HMLAN_OBJS)
 
 hmsniff: $(HMSNIFF_OBJS)
 
+flash-hmcfgusb: $(FLASH_HMCFGUSB_OBJS)
+
 clean:
-	rm -f $(HMLAN_OBJS) $(HMSNIFF_OBJS) $(DEPEND) hmland hmsniff
+	rm -f $(HMLAN_OBJS) $(HMSNIFF_OBJS) $(FLASH_HMCFGUSB_OBJS) $(DEPEND) hmland hmsniff flash-hmcfgusb
 
 .PHONY: all clean
diff --git a/flash-hmcfgusb.c b/flash-hmcfgusb.c
new file mode 100644
index 0000000..0308442
--- /dev/null
+++ b/flash-hmcfgusb.c
@@ -0,0 +1,129 @@
+/* (not working) flasher for HM-CFG-USB
+ *
+ * Copyright (c) 2013 Michael Gernoth <michael@gernoth.net>
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to
+ * deal in the Software without restriction, including without limitation the
+ * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
+ * sell copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
+ * IN THE SOFTWARE.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <stdint.h>
+#include <string.h>
+#include <strings.h>
+#include <poll.h>
+#include <errno.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <sys/time.h>
+#include <libusb-1.0/libusb.h>
+
+#include "hexdump.h"
+#include "hmcfgusb.h"
+
+struct recv_data {
+};
+
+static int parse_hmcfgusb(uint8_t *buf, int buf_len, void *data)
+{
+	if (buf_len < 1)
+		return 1;
+
+	switch(buf[0]) {
+		case 'E':
+		case 'H':
+		case 'R':
+		case 'I':
+			break;
+		default:
+			hexdump(buf, buf_len, "Unknown> ");
+			break;
+	}
+
+	return 1;
+}
+
+static uint8_t ascii_to_nibble(uint8_t a)
+{
+	uint8_t c = 0x00;
+
+	if ((a >= '0') && (a <= '9')) {
+		c = a - '0';
+	} else if ((a >= 'A') && (a <= 'F')) {
+		c = (a - 'A') + 10;
+	} else if ((a >= 'a') && (a <= 'f')) {
+		c = (a - 'a') + 10;
+	}
+
+	return c;
+}
+
+int main(int argc, char **argv)
+{
+	struct hmcfgusb_dev *dev;
+	struct recv_data rdata;
+	uint8_t out[0x40]; //FIXME!!!
+	uint8_t buf[0x80];
+	int fd;
+	int r;
+	int i;
+	int cnt;
+
+	hmcfgusb_set_debug(0);
+
+	memset(&rdata, 0, sizeof(rdata));
+
+	dev = hmcfgusb_init(parse_hmcfgusb, &rdata);
+	if (!dev) {
+		fprintf(stderr, "Can't initialize HM-CFG-USB\n");
+		exit(EXIT_FAILURE);
+	}
+	printf("HM-CFG-USB opened!\n");
+
+	fd = open("hmusbif.enc", O_RDONLY);
+	if (fd < 0) {
+		perror("Can't open hmusbif.enc");
+		exit(EXIT_FAILURE);
+	}
+
+	cnt = 0;
+	do {
+		memset(buf, 0, sizeof(buf));
+		r = read(fd, buf, sizeof(buf));
+		if (r < 0) {
+			perror("read");
+			exit(EXIT_FAILURE);
+		} else if (r == 0) {
+			break;
+		}
+		memset(out, 0, sizeof(out));
+		for (i = 0; i < r; i+=2) {
+			out[i/2] = (ascii_to_nibble(buf[i]) & 0xf)<< 4;
+			out[i/2] |= ascii_to_nibble(buf[i+1]) & 0xf;
+		}
+		cnt += r/2;
+		printf("Flashing %d bytes...\n", cnt);
+		hmcfgusb_send(dev, out, r/2, 1);
+	} while (r > 0);
+
+	hmcfgusb_close(dev);
+
+	return EXIT_SUCCESS;
+}
-- 
2.39.2