| /* |
| * 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/linkage.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, rp, rv |
| .endm |
| |
| #if defined(CONFIG_CPU_V6) || defined(CONFIG_CPU_V6K) || defined(CONFIG_CPU_V7) |
| |
| .macro senduart, rd, rx |
| mcr p14, 0, \rd, c0, c5, 0 |
| .endm |
| |
| .macro busyuart, rd, rx |
| 1001: |
| mrc p14, 0, \rx, c0, c1, 0 |
| tst \rx, #0x20000000 |
| beq 1001b |
| .endm |
| |
| .macro waituart, rd, rx |
| mov \rd, #0x2000000 |
| 1001: |
| subs \rd, \rd, #1 |
| bmi 1002f |
| mrc p14, 0, \rx, c0, c1, 0 |
| tst \rx, #0x20000000 |
| bne 1001b |
| 1002: |
| .endm |
| |
| #elif defined(CONFIG_CPU_XSCALE) |
| |
| .macro senduart, rd, rx |
| mcr p14, 0, \rd, c8, c0, 0 |
| .endm |
| |
| .macro busyuart, rd, rx |
| 1001: |
| mrc p14, 0, \rx, c14, c0, 0 |
| tst \rx, #0x10000000 |
| beq 1001b |
| .endm |
| |
| .macro waituart, rd, rx |
| mov \rd, #0x10000000 |
| 1001: |
| subs \rd, \rd, #1 |
| bmi 1002f |
| mrc p14, 0, \rx, c14, c0, 0 |
| tst \rx, #0x10000000 |
| bne 1001b |
| 1002: |
| .endm |
| |
| #else |
| |
| .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 |
| |
| #endif /* CONFIG_CPU_V6 */ |
| |
| #else |
| #include <mach/debug-macro.S> |
| #endif /* CONFIG_DEBUG_ICEDCC */ |
| |
| #ifdef CONFIG_MMU |
| .macro addruart_current, rx, tmp1, tmp2 |
| addruart \tmp1, \tmp2 |
| mrc p15, 0, \rx, c1, c0 |
| tst \rx, #1 |
| moveq \rx, \tmp1 |
| movne \rx, \tmp2 |
| .endm |
| |
| #else /* !CONFIG_MMU */ |
| .macro addruart_current, rx, tmp1, tmp2 |
| addruart \rx, \tmp1 |
| .endm |
| |
| #endif /* CONFIG_MMU */ |
| |
| /* |
| * Useful debugging routines |
| */ |
| ENTRY(printhex8) |
| mov r1, #8 |
| b printhex |
| ENDPROC(printhex8) |
| |
| ENTRY(printhex4) |
| mov r1, #4 |
| b printhex |
| ENDPROC(printhex4) |
| |
| 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 |
| ENDPROC(printhex2) |
| |
| hexbuf: .space 16 |
| |
| .ltorg |
| |
| ENTRY(printascii) |
| addruart_current r3, r1, r2 |
| 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 |
| ENDPROC(printascii) |
| |
| ENTRY(printch) |
| addruart_current r3, r1, r2 |
| mov r1, r0 |
| mov r0, #0 |
| b 1b |
| ENDPROC(printch) |