ao_dbg_send_bits(uint8_t msk, uint8_t val)
{
P0 = (P0 & ~msk) | (val & msk);
+ _asm
+ nop
+ nop
+ _endasm;
}
-#define ao_dbg_pause() do { _asm nop; nop; nop _endasm; } while (0);
-
void
ao_dbg_send_byte(uint8_t byte)
{
d = DBG_DATA;
byte <<= 1;
ao_dbg_send_bits(DBG_CLOCK|DBG_DATA, DBG_CLOCK|d);
- ao_dbg_pause();
ao_dbg_send_bits(DBG_CLOCK|DBG_DATA, 0 |d);
- ao_dbg_pause();
}
P0DIR &= ~DBG_DATA;
}
for (b = 0; b < 8; b++) {
byte = byte << 1;
ao_dbg_send_bits(DBG_CLOCK, DBG_CLOCK);
- ao_dbg_pause();
if (DBG_DATA_PIN)
byte |= 1;
ao_dbg_send_bits(DBG_CLOCK, 0);
- ao_dbg_pause();
}
return byte;
}
P0DIR = DBG_RESET_N | DBG_CLOCK;
}
+static void
+ao_dbg_long_delay(void)
+{
+ uint8_t n;
+
+ for (n = 0; n < 20; n++)
+ _asm nop _endasm;
+}
+
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();
}
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();
}
static void
static uint8_t
getnibble(void)
{
- __xdata uint8_t c;
+ __xdata char c;
c = getchar();
if ('0' <= c && c <= '9')
}
__code struct ao_cmds ao_dbg_cmds[7] = {
- { 'D', debug_enable, "D Enable debug mode\n" },
- { 'G', debug_get, "G <count> Get data from debug port\n" },
- { 'I', debug_input, "I <count> <addr> Input <count> bytes to target at <addr>\n" },
- { 'O', debug_output, "O <count> <addr> Output <count> bytes to target at <addr>\n" },
- { 'P', debug_put, "P <byte> ... Put data to debug port\n" },
- { 'R', debug_reset, "R Reset target\n" },
+ { 'D', debug_enable, "D Enable debug mode" },
+ { 'G', debug_get, "G <count> Get data from debug port" },
+ { 'I', debug_input, "I <count> <addr> Input <count> bytes to target at <addr>" },
+ { 'O', debug_output, "O <count> <addr> Output <count> bytes to target at <addr>" },
+ { 'P', debug_put, "P <byte> ... Put data to debug port" },
+ { 'R', debug_reset, "R Reset target" },
{ 0, debug_reset, 0 },
};