X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=lib%2Fccdbg-command.c;h=74313bdf8ebbd0aea3485f32232b786aaafecc67;hp=2b29fdee72c8a49573ef9910632a948e73a4b9ae;hb=cc0495b7028f4b1189a00707d828a68534d1dea2;hpb=1264c3676e95427bba5d01e05c303d036a7f9eca

diff --git a/lib/ccdbg-command.c b/lib/ccdbg-command.c
index 2b29fdee..74313bdf 100644
--- a/lib/ccdbg-command.c
+++ b/lib/ccdbg-command.c
@@ -27,11 +27,12 @@ ccdbg_debug_mode(struct ccdbg *dbg)
 	ccdbg_debug(CC_DEBUG_COMMAND, "#\n");
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N,          CC_DATA           );
+	ccdbg_wait_reset(dbg);
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N,          CC_DATA           );
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N,          CC_DATA|CC_RESET_N);
-	ccdbg_sync_io(dbg);
+	ccdbg_wait_reset(dbg);
 }
 
 void
@@ -42,11 +43,12 @@ ccdbg_reset(struct ccdbg *dbg)
 	ccdbg_debug(CC_DEBUG_COMMAND, "#\n");
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
+	ccdbg_wait_reset(dbg);
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 	ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
-	ccdbg_sync_io(dbg);
+	ccdbg_wait_reset(dbg);
 }
 
 uint8_t
@@ -70,7 +72,14 @@ ccdbg_rd_config(struct ccdbg *dbg)
 uint16_t
 ccdbg_get_pc(struct ccdbg *dbg)
 {
-	return ccdbg_cmd_write_read16(dbg, CC_GET_PC, NULL, 0);
+	uint16_t	pc1, pc2;
+
+	pc1 = ccdbg_cmd_write_read16(dbg, CC_GET_PC, NULL, 0);
+	pc2 = ccdbg_cmd_write_read16(dbg, CC_GET_PC, NULL, 0);
+	if (pc1 != pc2)
+		fprintf (stderr, "Invalid pc %04x != %04x\n",
+			 pc1, pc2);
+	return pc2;
 }
 
 uint8_t