From e2fc5ed4ef73ea42d1d13e20d5e09260722d23a9 Mon Sep 17 00:00:00 2001 From: Tat-Chee Wan (USM) Date: Mon, 20 Jun 2011 16:24:36 +0800 Subject: implement detach and kill command support --- Debugger/debug_runlooptasks.S | 44 ++++++++++++++++++++++++++++++++++++++++++- 1 file changed, 43 insertions(+), 1 deletion(-) (limited to 'Debugger/debug_runlooptasks.S') diff --git a/Debugger/debug_runlooptasks.S b/Debugger/debug_runlooptasks.S index 48b7e5a..ceab2e9 100644 --- a/Debugger/debug_runlooptasks.S +++ b/Debugger/debug_runlooptasks.S @@ -115,13 +115,55 @@ dbg__runloopTasks: b nx_core_reset /* Reboot Brick, won't return */ #else + .extern dIOCtrlSetPower + .extern dIOCtrlSetPwm + .extern dIOCtrlTransfer + .equ BOOT, 0xA55A + .equ POWERDOWN, 0x5A00 /**************************************************************************** * * NXT Firmware Reboot Routine * ****************************************************************************/ dbg__reboot: - bx lr + /* Powerdown Sequence + dIOCtrlSetPower((POWERDOWN>>8)); + dIOCtrlTransfer(); + + Reboot Sequence + dIOCtrlSetPower((UBYTE)(BOOT>>8)); + dIOCtrlSetPwm((UBYTE)BOOT); + dIOCtrlTransfer(); + */ + + /* We implement the powerdown sequence for now */ + +#if 1 + /* Powerdown sequence */ + ldr r0, =((POWERDOWN >> 8) & 0xFF) + ldr r1, =dIOCtrlSetPower + mov lr,pc + bx r1 +#endif + +#if 0 + /* Reboot sequence: this forces SAMBA mode??!! */ + ldr r0, =((BOOT >> 8) & 0xFF) + ldr r1, =dIOCtrlSetPower + mov lr,pc + bx r1 + + ldr r0, =(BOOT & 0xFF) + ldr r1, =dIOCtrlSetPwm + mov lr,pc + bx r1 +#endif + + ldr r1, =dIOCtrlTransfer + mov lr,pc + bx r1 + + b . /* Wait for AVR... */ #endif -- cgit v1.2.3