X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ccdbg.c;h=a35481438bc4db6b8897d95429a219df4d87679e;hp=6462739a56b08747d55fe74aa6a5337c1c8a05a6;hb=807e2adacb025af77bb53c03209e9c8e0d7a5f95;hpb=e64b4dbf15e9ee1cb0de002985de7575e83d46e9

diff --git a/ccdbg.c b/ccdbg.c
index 6462739a..a3548143 100644
--- a/ccdbg.c
+++ b/ccdbg.c
@@ -18,226 +18,42 @@
 
 #include "ccdbg.h"
 
-static void
-get_bit(char *line, int i, char on, uint8_t bit, uint8_t *bits, uint8_t *masks)
-{
-	if (line[i] == on) {
-		*bits |= bit;
-		*masks |= bit;
-		return;
-	}
-	if (line[i] == '.') {
-		*masks |= bit;
-		return;
-	}
-	if (line[i] == '-') {
-		return;
-	}
-	fprintf(stderr, "bad line %s\n", line);
-	exit (1);
-}
-
-static char
-is_bit(uint8_t get, uint8_t mask, char on, uint8_t bit)
-{
-	if (mask&bit) {
-		if (get&bit)
-			return on;
-		else
-			return '.';
-	} else
-		return '-';
-}
-
-static uint8_t
-ccdbg_write_read(struct ccdbg *dbg, uint8_t set, uint8_t mask)
-{
-	uint8_t	get = set;
-
-	if (mask != (CC_DATA|CC_CLOCK|CC_RESET_N))
-		get = ccdbg_read(dbg);
-	ccdbg_write(dbg, mask, set);
-	printf ("%c %c %c",
-		is_bit(set, mask, 'C', CC_CLOCK),
-		is_bit(set, mask, 'D', CC_DATA),
-		is_bit(set, mask, 'R', CC_RESET_N));
-	if (mask != (CC_DATA|CC_CLOCK|CC_RESET_N))
-		printf(" -> %c %c %c",
-		       is_bit(get, 0xf, 'C', CC_CLOCK),
-		       is_bit(get, 0xf, 'D', CC_DATA),
-		       is_bit(get, 0xf, 'R', CC_RESET_N));
-	printf("\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, CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg,          CC_DATA           , CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           , CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg,          CC_DATA           , CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           , CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg,          CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
-}
-
-static void
-_ccdbg_reset(struct ccdbg *dbg)
-{
-	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           , CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA           , CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, 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, CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_write_read(dbg,          bit|CC_RESET_N, CC_CLOCK|CC_DATA|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);
-}
+#define MOV_direct_data		0x75
+#define LJMP			0x02
+#define MOV_Rn_data(n)		(0x78 | (n))
+#define DJNZ_Rn_rel(n)		(0xd8 | (n))
 
-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, CC_CLOCK|CC_RESET_N);
-		get = ccdbg_write_read(dbg,          CC_DATA|CC_RESET_N, CC_CLOCK|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, mask;
+#if 0
+static uint8_t instructions[] = {
+	3, MOV_direct_data, 0xfe, 0x02,
+	3, MOV_direct_data, 0x90, 0xff,
+	0
+};
+#endif
 
-	while (fgets(line, sizeof line, input)) {
-		if (line[0] == '#' || line[0] == '\n') {
-			printf ("%s", line);
-			continue;
-		}
-		set = 0;
-		mask = 0;
-		get_bit(line, 0, 'C', CC_CLOCK, &set, &mask);
-		get_bit(line, 2, 'D', CC_DATA, &set, &mask);
-		get_bit(line, 4, 'R', CC_RESET_N, &set, &mask);
-		ccdbg_write_read(dbg, set, mask);
-	}
-}
+static uint8_t mem_instr[] = {
+	MOV_direct_data, 0xfe, 0x02,
+	MOV_direct_data, 0x90, 0xff,
+	MOV_Rn_data(2), 0x10,
+	MOV_Rn_data(0), 0xff,
+	MOV_Rn_data(1), 0xff,
+	DJNZ_Rn_rel(1), 0xfe,
+	DJNZ_Rn_rel(0), 0xfa,
+	DJNZ_Rn_rel(2), 0xf6,
+	MOV_direct_data, 0x90, 0xfd,
+	MOV_Rn_data(2), 0x10,
+	MOV_Rn_data(0), 0xff,
+	MOV_Rn_data(1), 0xff,
+	DJNZ_Rn_rel(1), 0xfe,
+	DJNZ_Rn_rel(0), 0xfa,
+	DJNZ_Rn_rel(2), 0xf6,
+	LJMP, 0xf0, 0x03
+};
+
+static uint8_t jump_mem[] = {
+	3, LJMP, 0xf0, 0x00,
+	0
+};
 
 int
 main (int argc, char **argv)
@@ -245,22 +61,36 @@ main (int argc, char **argv)
 	struct ccdbg	*dbg;
 	uint8_t		status;
 	uint16_t	chip_id;
+	uint16_t	pc;
+	uint8_t		memory[0x10];
+	int		i;
 
 	dbg = ccdbg_open("/dev/ttyUSB0");
 	if (!dbg)
 		exit (1);
-#if 0	
-	_ccdbg_play(dbg, 0, 0);
-	_ccdbg_play_many(dbg, 8);
-#endif
-	ccdbg_manual(dbg, stdin);
 #if 0
+	ccdbg_manual(dbg, stdin);
+#endif
+#if 1
+	ccdbg_reset(dbg);
 	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);
+	status = ccdbg_halt(dbg);
+	printf ("halt status: 0x%02x\n", status);
+/*	ccdbg_execute(dbg, instructions); */
+	ccdbg_write_memory(dbg, 0xf000, mem_instr, sizeof (mem_instr));
+	ccdbg_read_memory(dbg, 0xf000, memory, sizeof (memory));
+	for (i = 0; i < sizeof (memory); i++)
+		printf (" %02x", memory[i]);
+	printf ("\n");
+	ccdbg_execute(dbg, jump_mem);
+	pc = ccdbg_get_pc(dbg);
+	printf ("pc starts at 0x%04x\n", pc);
+	status = ccdbg_resume(dbg);
+	printf ("resume status: 0x%02x\n", status);
 #endif
 	ccdbg_close(dbg);
 	exit (0);