| /* | |
| * 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 |