/* | |
* linux/arch/arm/kernel/debug.S | |
* | |
* Copyright (C) 1994-1999 Russell King | |
* | |
* This program is free software; you can redistribute it and/or modify | |
* it under the terms of the GNU General Public License version 2 as | |
* published by the Free Software Foundation. | |
* | |
* 32-bit debugging code | |
*/ | |
#include <linux/config.h> | |
#include <linux/linkage.h> | |
#include <asm/hardware.h> | |
.text | |
/* | |
* Some debugging routines (useful if you've got MM problems and | |
* printk isn't working). For DEBUGGING ONLY!!! Do not leave | |
* references to these in a production kernel! | |
*/ | |
#if defined(CONFIG_DEBUG_ICEDCC) | |
@@ debug using ARM EmbeddedICE DCC channel | |
.macro addruart, rx | |
.endm | |
.macro senduart, rd, rx | |
mcr p14, 0, \rd, c1, c0, 0 | |
.endm | |
.macro busyuart, rd, rx | |
1001: | |
mrc p14, 0, \rx, c0, c0, 0 | |
tst \rx, #2 | |
beq 1001b | |
.endm | |
.macro waituart, rd, rx | |
mov \rd, #0x2000000 | |
1001: | |
subs \rd, \rd, #1 | |
bmi 1002f | |
mrc p14, 0, \rx, c0, c0, 0 | |
tst \rx, #2 | |
bne 1001b | |
1002: | |
.endm | |
#else | |
#include <asm/arch/debug-macro.S> | |
#endif | |
/* | |
* Useful debugging routines | |
*/ | |
ENTRY(printhex8) | |
mov r1, #8 | |
b printhex | |
ENTRY(printhex4) | |
mov r1, #4 | |
b printhex | |
ENTRY(printhex2) | |
mov r1, #2 | |
printhex: adr r2, hexbuf | |
add r3, r2, r1 | |
mov r1, #0 | |
strb r1, [r3] | |
1: and r1, r0, #15 | |
mov r0, r0, lsr #4 | |
cmp r1, #10 | |
addlt r1, r1, #'0' | |
addge r1, r1, #'a' - 10 | |
strb r1, [r3, #-1]! | |
teq r3, r2 | |
bne 1b | |
mov r0, r2 | |
b printascii | |
.ltorg | |
ENTRY(printascii) | |
addruart r3 | |
b 2f | |
1: waituart r2, r3 | |
senduart r1, r3 | |
busyuart r2, r3 | |
teq r1, #'\n' | |
moveq r1, #'\r' | |
beq 1b | |
2: teq r0, #0 | |
ldrneb r1, [r0], #1 | |
teqne r1, #0 | |
bne 1b | |
mov pc, lr | |
ENTRY(printch) | |
addruart r3 | |
mov r1, r0 | |
mov r0, #0 | |
b 1b | |
hexbuf: .space 16 |