X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ccdbg.c;h=39fc1016becd3becc60a3cce237dd67995f246c1;hp=a2b5946db62ec0ad8e4d7fd14a9ff0e18a492c22;hb=3709ec3205cfb152b6568f3ea505c67fe7504c2a;hpb=01cb2799875e086ee6096627c058ee235bbc33d5

diff --git a/ccdbg.c b/ccdbg.c
index a2b5946d..39fc1016 100644
--- a/ccdbg.c
+++ b/ccdbg.c
@@ -18,18 +18,234 @@
 
 #include "ccdbg.h"
 
+static uint8_t
+get_bit(char *line, int i, char on, uint8_t bit)
+{
+	if (line[i] == on)
+		return bit;
+	if (line[i] == '.')
+		return 0;
+	fprintf(stderr, "bad line %s\n", line);
+	exit (1);
+}
+
+static char
+is_bit(uint8_t get, char on, uint8_t bit)
+{
+	if (get&bit)
+		return on;
+	else
+		return '.';
+}
+
+static uint8_t
+ccdbg_write_read(struct ccdbg *dbg, uint8_t set)
+{
+	uint8_t	get;
+
+	ccdbg_write(dbg, CC_DATA|CC_CLOCK|CC_RESET_N, set);
+	get = ccdbg_read(dbg);
+	printf("%c %c %c -> %c %c %c\n",
+	       is_bit(set, 'C', CC_CLOCK),
+	       is_bit(set, 'D', CC_DATA),
+	       is_bit(set, 'R', CC_RESET_N),
+	       is_bit(get, 'C', CC_CLOCK),
+	       is_bit(get, 'D', CC_DATA),
+	       is_bit(get, 'R', CC_RESET_N));
+	ccdbg_half_clock(dbg);
+	return get;
+}
+
+static void
+_ccdbg_debug_mode(struct ccdbg *dbg)
+{
+	printf ("#\n");
+	printf ("# Debug mode\n");
+	printf ("#\n");
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
+	ccdbg_write_read(dbg,          CC_DATA           );
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           );
+	ccdbg_write_read(dbg,          CC_DATA           );
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           );
+	ccdbg_write_read(dbg,          CC_DATA|CC_RESET_N);
+}
+
+static void
+_ccdbg_reset(struct ccdbg *dbg)
+{
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           );
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           );
+	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
+}
+
+static void
+_ccdbg_send_bit(struct ccdbg *dbg, uint8_t bit)
+{
+	if (bit) bit = CC_DATA;
+	ccdbg_write_read(dbg, CC_CLOCK|bit|CC_RESET_N);
+	ccdbg_write_read(dbg,          bit|CC_RESET_N);
+}
+
+static void
+_ccdbg_send_byte(struct ccdbg *dbg, uint8_t byte)
+{
+	int bit;
+	printf ("#\n");
+	printf ("# Send Byte 0x%02x\n", byte);
+	printf ("#\n");
+	for (bit = 7; bit >= 0; bit--) {
+		_ccdbg_send_bit(dbg, (byte >> bit) & 1);
+		if (bit == 3)
+			printf ("\n");
+	}
+}
+
+static void
+_ccdbg_send_bits(struct ccdbg *dbg, int n, uint32_t bits)
+{
+	int bit;
+	printf ("#\n");
+	printf ("# Send %d bits 0x%08x\n", n, bits);
+	printf ("#\n");
+	for (bit = n - 1; bit >= 0; bit--) {
+		_ccdbg_send_bit(dbg, (bits >> bit) & 1);
+		if ((bit & 3) == 3)
+			printf ("\n");
+	}
+}
+
+static void
+_ccdbg_print_bits(int n, uint32_t bits)
+{
+	int	bit;
+
+	for (bit = n - 1; bit >= 0; bit--)
+		printf ("%d", (bits >> bit) & 1);
+}
+
+static uint32_t
+_ccdbg_read_bits(struct ccdbg *dbg, int bits)
+{
+	int		bit;
+	uint32_t	val = 0;
+	uint8_t		get;
+
+	printf ("#\n");
+	printf ("# Read %d bits\n", bits);
+	printf ("#\n");
+	for (bit = 0; bit < bits; bit++) {
+		      ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N);
+		get = ccdbg_write_read(dbg,          CC_DATA|CC_RESET_N);
+		val <<= 1;
+		if (get & CC_DATA)
+			val |= 1;
+		if ((bit & 3) == 3)
+			printf ("\n");
+	}
+	printf ("#\n");
+	printf ("# Read "); _ccdbg_print_bits(bits, val); printf ("\n");
+	printf ("#\n");
+	return val;
+}
+
+static int
+_ccdbg_check_bits(uint32_t bits, uint8_t match)
+{
+	int	bit;
+
+	for (bit = 0; bit < 24; bit++)
+		if (((bits >> bit) & 0xff) == match)
+			return 1;
+	return 0;
+}
+
+static uint32_t
+_ccdbg_play(struct ccdbg *dbg, int num_sync, uint32_t sync)
+{
+	uint32_t	bits;
+	_ccdbg_debug_mode(dbg);
+	_ccdbg_send_bits(dbg, num_sync, sync);
+	_ccdbg_send_byte(dbg, CC_GET_CHIP_ID);
+	bits = _ccdbg_read_bits(dbg, 16);
+	_ccdbg_send_byte(dbg, CC_GET_CHIP_ID);
+	bits = _ccdbg_read_bits(dbg, 16);
+//	_ccdbg_send_byte(dbg, CC_READ_STATUS);
+	_ccdbg_reset(dbg);
+	if (_ccdbg_check_bits(bits, 0x11)) {
+		printf("#\n#match with %d bits 0x%08x\n#\n", num_sync, sync);
+		return 1;
+	}
+	return 0;
+}
+
+static int
+_ccdbg_play_num(struct ccdbg *dbg, int num)
+{
+	uint32_t	sync;
+	uint32_t	max;
+
+	printf ("#\n#play %d\n#\n", num);
+	max = (1 << num);
+	for (sync = 0; sync < max; sync++)
+		if (_ccdbg_play(dbg, num, sync))
+			return 1;
+	return 0;
+}
+
+static int
+_ccdbg_play_many(struct ccdbg *dbg, int max)
+{
+	int	num;
+
+	for (num = 0; num < max; num++)
+		if (_ccdbg_play_num(dbg, num))
+			return 1;
+	return 0;
+}
+
+static void
+ccdbg_manual(struct ccdbg *dbg, FILE *input)
+{
+	char	line[80];
+	uint8_t	set;
+
+	while (fgets(line, sizeof line, input)) {
+		if (line[0] == '#' || line[0] == '\n') {
+			printf ("%s", line);
+			continue;
+		}
+		set = 0;
+		set |= get_bit(line, 0, 'C', CC_CLOCK);
+		set |= get_bit(line, 2, 'D', CC_DATA);
+		set |= get_bit(line, 4, 'R', CC_RESET_N);
+		ccdbg_write_read(dbg, set);
+	}
+}
+
 int
 main (int argc, char **argv)
 {
 	struct ccdbg	*dbg;
 	uint8_t		status;
+	uint16_t	chip_id;
 
 	dbg = ccdbg_open("/dev/ttyUSB0");
 	if (!dbg)
 		exit (1);
-	ccdbg_reset(dbg);
+#if 0	
+	_ccdbg_play(dbg, 0, 0);
+	_ccdbg_play_many(dbg, 8);
+#endif
+	ccdbg_manual(dbg, stdin);
+#if 0
+	ccdbg_debug_mode(dbg);
 	status = ccdbg_read_status(dbg);
 	printf("Status: 0x%02x\n", status);
+	chip_id = ccdbg_get_chip_id(dbg);
+	printf("Chip id: 0x%04x\n", chip_id);
+	_ccdbg_reset(dbg);
+#endif
 	ccdbg_close(dbg);
 	exit (0);
 }