X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fao_dbg.c;h=2988aed4491eab019b5b65c4d5a0d827c3612002;hb=refs%2Ftags%2Fdebian%2F0.6%2B193%2Bg314d27a;hp=c8dc6ddcc0c867dc9aad10c2875fc6ad89fbfd9b;hpb=17d2432a8b9c15963cd3b821f025ad33972ef477;p=fw%2Faltos

diff --git a/src/ao_dbg.c b/src/ao_dbg.c
index c8dc6ddc..2988aed4 100644
--- a/src/ao_dbg.c
+++ b/src/ao_dbg.c
@@ -16,19 +16,12 @@
  */
 
 #include "ao.h"
-
-#define DBG_CLOCK	(1 << 3)
-#define DBG_DATA	(1 << 4)
-#define DBG_RESET_N	(1 << 5)
-
-#define DBG_CLOCK_PIN	(P0_3)
-#define DBG_DATA_PIN	(P0_4)
-#define DBG_RESET_N_PIN	(P0_5)
+#include "ao_pins.h"
 
 static void
-ao_dbg_send_bits(uint8_t msk, uint8_t val)
+ao_dbg_send_bits(uint8_t msk, uint8_t val) __reentrant
 {
-	P0 = (P0 & ~msk) | (val & msk);
+	DBG_PORT = (DBG_PORT & ~msk) | (val & msk);
 	_asm
 		nop
 		nop
@@ -40,8 +33,8 @@ ao_dbg_send_byte(uint8_t byte)
 {
 	__xdata uint8_t	b, d;
 
-	P0 |= DBG_DATA;
-	P0DIR |= DBG_DATA;
+	DBG_PORT |= DBG_DATA;
+	DBG_PORT_DIR |= DBG_DATA;
 	for (b = 0; b < 8; b++) {
 		d = 0;
 		if (byte & 0x80)
@@ -50,7 +43,7 @@ ao_dbg_send_byte(uint8_t byte)
 		ao_dbg_send_bits(DBG_CLOCK|DBG_DATA, DBG_CLOCK|d);
 		ao_dbg_send_bits(DBG_CLOCK|DBG_DATA,     0    |d);
 	}
-	P0DIR &= ~DBG_DATA;
+	DBG_PORT_DIR &= ~DBG_DATA;
 }
 
 uint8_t
@@ -171,67 +164,41 @@ ao_dbg_read_byte(void)
 static void
 ao_dbg_set_pins(void)
 {
-	/* Disable peripheral use of P0 */
-	ADCCFG = 0;
-	P0SEL = 0;
-
-
-	/* make P0_4 tri-state */
-	P0INP = DBG_DATA;
-	P2INP &= ~(P2INP_PDUP0_PULL_DOWN);
+	/* make DBG_DATA tri-state */
+	DBG_PORT_INP |= DBG_DATA;
 
 	/* Raise RESET_N and CLOCK */
-	P0 = DBG_RESET_N | DBG_CLOCK;
+	DBG_PORT |= DBG_RESET_N | DBG_CLOCK;
 
 	/* RESET_N and CLOCK are outputs now */
-	P0DIR = DBG_RESET_N | DBG_CLOCK;
+	DBG_PORT_DIR |= DBG_RESET_N | DBG_CLOCK;
+	DBG_PORT_DIR &= ~DBG_DATA;
 }
 
-static void
-ao_dbg_long_delay(void)
-{
-	uint8_t	n;
-
-	for (n = 0; n < 20; n++)
-		_asm nop _endasm;
-}
+#define ao_reset_delay()	ao_delay(AO_MS_TO_TICKS(20))
 
 void
 ao_dbg_debug_mode(void)
 {
-	ao_dbg_set_pins();
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|DBG_RESET_N);
-	ao_dbg_long_delay();
+	ao_dbg_set_pins();	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0      );  	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|    0      );  	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0      );	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|    0      );	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0      );	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|DBG_RESET_N);	ao_reset_delay();
 }
 
 void
 ao_dbg_reset(void)
 {
-	ao_dbg_set_pins();
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0    );
-	ao_dbg_long_delay();
-	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);
-	ao_dbg_long_delay();
+	ao_dbg_set_pins();									ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|    0      );	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N, DBG_CLOCK|DBG_DATA|DBG_RESET_N);	ao_reset_delay();
+	ao_dbg_send_bits(DBG_CLOCK|DBG_DATA|DBG_RESET_N,     0    |DBG_DATA|DBG_RESET_N);	ao_reset_delay();
 }
 
 static void