[hmcfgusb] / flash-hmcfgusb.c

/* (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[4096];
	uint8_t buf[4096];
	uint8_t *outp;
	int fd;
	int r;
	int i;
	int cnt;
	int pkt;

	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;
	pkt = 0;
	do {
		int len;

		memset(buf, 0, sizeof(buf));
		r = read(fd, buf, 4);
		if (r < 0) {
			perror("read");
			exit(EXIT_FAILURE);
		} else if (r == 0) {
			break;
		} else if (r != 4) {
			printf("can't get length information!\n");
			exit(EXIT_FAILURE);
		}

		len = (ascii_to_nibble(buf[0]) & 0xf)<< 4;
		len |= ascii_to_nibble(buf[1]) & 0xf;
		len <<= 8;
		len |= (ascii_to_nibble(buf[2]) & 0xf)<< 4;
		len |= ascii_to_nibble(buf[3]) & 0xf;

		printf("packet length: %x\n", len);

		r = read(fd, buf, len * 2);
		if (r < 0) {
			perror("read");
			exit(EXIT_FAILURE);
		} else if (r < len * 2) {
			printf("short read, aborting (%d < %d)\n", r, len * 2);
			break;
		}

		memset(out, 0, sizeof(out));
		outp = out;
		*outp++ = 'W';
		*outp++ = (pkt >> 8) & 0xff;
		*outp++ = pkt & 0xff;
		*outp++ = (len >> 8) & 0xff;
		*outp++ = len & 0xff;
		for (i = 0; i < r; i+=2) {
			*outp = (ascii_to_nibble(buf[i]) & 0xf)<< 4;
			*outp |= ascii_to_nibble(buf[i+1]) & 0xf;
			outp++;
		}
		cnt += r/2;
		printf("Flashing %d bytes...\n", cnt);
		hexdump(out, outp-out, "F> ");
		//hmcfgusb_send(dev, out, r/2, 1);
		pkt++;
	} while (r > 0);

	hmcfgusb_close(dev);

	return EXIT_SUCCESS;
}
Commit	Line	Data
9fb0f4d2 MG	1	/* (not working) flasher for HM-CFG-USB
	2	*
	3	* Copyright (c) 2013 Michael Gernoth <michael@gernoth.net>
	4	*
	5	* Permission is hereby granted, free of charge, to any person obtaining a copy
	6	* of this software and associated documentation files (the "Software"), to
	7	* deal in the Software without restriction, including without limitation the
	8	* rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
	9	* sell copies of the Software, and to permit persons to whom the Software is
	10	* furnished to do so, subject to the following conditions:
	11	*
	12	* The above copyright notice and this permission notice shall be included in
	13	* all copies or substantial portions of the Software.
	14	*
	15	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	16	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	17	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
	18	* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	19	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
	20	* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
	21	* IN THE SOFTWARE.
	22	*/
	23
	24	#include <stdio.h>
	25	#include <stdlib.h>
	26	#include <unistd.h>
	27	#include <stdint.h>
	28	#include <string.h>
	29	#include <strings.h>
	30	#include <poll.h>
	31	#include <errno.h>
	32	#include <sys/types.h>
	33	#include <sys/stat.h>
	34	#include <fcntl.h>
	35	#include <sys/time.h>
	36	#include <libusb-1.0/libusb.h>
	37
	38	#include "hexdump.h"
	39	#include "hmcfgusb.h"
	40
	41	struct recv_data {
	42	};
	43
	44	static int parse_hmcfgusb(uint8_t buf, int buf_len, void data)
	45	{
	46	if (buf_len < 1)
	47	return 1;
	48
	49	switch(buf[0]) {
	50	case 'E':
	51	case 'H':
	52	case 'R':
	53	case 'I':
	54	break;
	55	default:
	56	hexdump(buf, buf_len, "Unknown> ");
	57	break;
	58	}
	59
	60	return 1;
	61	}
	62
	63	static uint8_t ascii_to_nibble(uint8_t a)
	64	{
65	uint8_t c = 0x00;
66
67	if ((a >= '0') && (a <= '9')) {
68	c = a - '0';
69	} else if ((a >= 'A') && (a <= 'F')) {
70	c = (a - 'A') + 10;
71	} else if ((a >= 'a') && (a <= 'f')) {
72	c = (a - 'a') + 10;
73	}
74
75	return c;
76	}
77
78	int main(int argc, char **argv)
79	{
80	struct hmcfgusb_dev *dev;
81	struct recv_data rdata;
04e76de6 MG	82	uint8_t out[4096];
	83	uint8_t buf[4096];
	84	uint8_t *outp;
9fb0f4d2 MG	85	int fd;
	86	int r;
	87	int i;
	88	int cnt;
04e76de6	89	int pkt;
9fb0f4d2 MG	90
	91	hmcfgusb_set_debug(0);
	92
	93	memset(&rdata, 0, sizeof(rdata));
	94
	95	dev = hmcfgusb_init(parse_hmcfgusb, &rdata);
	96	if (!dev) {
	97	fprintf(stderr, "Can't initialize HM-CFG-USB\n");
	98	exit(EXIT_FAILURE);
	99	}
	100	printf("HM-CFG-USB opened!\n");
	101
	102	fd = open("hmusbif.enc", O_RDONLY);
	103	if (fd < 0) {
	104	perror("Can't open hmusbif.enc");
	105	exit(EXIT_FAILURE);
	106	}
	107
	108	cnt = 0;
04e76de6	109	pkt = 0;
9fb0f4d2	110	do {
04e76de6 MG	111	int len;
04e76de6 MG	112
9fb0f4d2	113	memset(buf, 0, sizeof(buf));
04e76de6	114	r = read(fd, buf, 4);
9fb0f4d2 MG	115	if (r < 0) {
	116	perror("read");
	117	exit(EXIT_FAILURE);
	118	} else if (r == 0) {
	119	break;
04e76de6 MG	120	} else if (r != 4) {
	121	printf("can't get length information!\n");
	122	exit(EXIT_FAILURE);
9fb0f4d2	123	}
04e76de6 MG	124
	125	len = (ascii_to_nibble(buf[0]) & 0xf)<< 4;
	126	len \|= ascii_to_nibble(buf[1]) & 0xf;
	127	len <<= 8;
	128	len \|= (ascii_to_nibble(buf[2]) & 0xf)<< 4;
	129	len \|= ascii_to_nibble(buf[3]) & 0xf;
	130
	131	printf("packet length: %x\n", len);
	132
	133	r = read(fd, buf, len * 2);
	134	if (r < 0) {
	135	perror("read");
	136	exit(EXIT_FAILURE);
	137	} else if (r < len * 2) {
	138	printf("short read, aborting (%d < %d)\n", r, len * 2);
	139	break;
	140	}
	141
9fb0f4d2	142	memset(out, 0, sizeof(out));
04e76de6 MG	143	outp = out;
	144	*outp++ = 'W';
	145	*outp++ = (pkt >> 8) & 0xff;
	146	*outp++ = pkt & 0xff;
	147	*outp++ = (len >> 8) & 0xff;
	148	*outp++ = len & 0xff;
9fb0f4d2	149	for (i = 0; i < r; i+=2) {
04e76de6 MG	150	*outp = (ascii_to_nibble(buf[i]) & 0xf)<< 4;
	151	*outp \|= ascii_to_nibble(buf[i+1]) & 0xf;
	152	outp++;
9fb0f4d2 MG	153	}
	154	cnt += r/2;
	155	printf("Flashing %d bytes...\n", cnt);
04e76de6 MG	156	hexdump(out, outp-out, "F> ");
	157	//hmcfgusb_send(dev, out, r/2, 1);
	158	pkt++;
9fb0f4d2 MG	159	} while (r > 0);
	160
	161	hmcfgusb_close(dev);
	162
	163	return EXIT_SUCCESS;
	164	}