arch/arm/kernel/debug.S

   1 /*
   2  *  linux/arch/arm/kernel/debug.S
   3  *
   4  *  Copyright (C) 1994-1999 Russell King
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  *  32-bit debugging code
  11  */
  12 #include <linux/linkage.h>
  13
  14                 .text
  15
  16 /*
  17  * Some debugging routines (useful if you've got MM problems and
  18  * printk isn't working).  For DEBUGGING ONLY!!!  Do not leave
  19  * references to these in a production kernel!
  20  */
  21
  22 #if defined(CONFIG_DEBUG_ICEDCC)
  23                 @@ debug using ARM EmbeddedICE DCC channel
  24
  25 #if defined(CONFIG_CPU_V6)
  26
  27                 .macro  addruart, rx
  28                 .endm
  29
  30                 .macro  senduart, rd, rx
  31                 mcr     p14, 0, \rd, c0, c5, 0
  32                 .endm
  33
  34                 .macro  busyuart, rd, rx
  35 1001:
  36                 mrc     p14, 0, \rx, c0, c1, 0
  37                 tst     \rx, #0x20000000
  38                 beq     1001b
  39                 .endm
  40
  41                 .macro  waituart, rd, rx
  42                 mov     \rd, #0x2000000
  43 1001:
  44                 subs    \rd, \rd, #1
  45                 bmi     1002f
  46                 mrc     p14, 0, \rx, c0, c1, 0
  47                 tst     \rx, #0x20000000
  48                 bne     1001b
  49 1002:
  50                 .endm
  51
  52 #else
  53
  54                 .macro  addruart, rx
  55                 .endm
  56
  57                 .macro  senduart, rd, rx
  58                 mcr     p14, 0, \rd, c1, c0, 0
  59                 .endm
  60
  61                 .macro  busyuart, rd, rx
  62 1001:
  63                 mrc     p14, 0, \rx, c0, c0, 0
  64                 tst     \rx, #2
  65                 beq     1001b
  66
  67                 .endm
  68
  69                 .macro  waituart, rd, rx
  70                 mov     \rd, #0x2000000
  71 1001:
  72                 subs    \rd, \rd, #1
  73                 bmi     1002f
  74                 mrc     p14, 0, \rx, c0, c0, 0
  75                 tst     \rx, #2
  76                 bne     1001b
  77 1002:
  78                 .endm
  79
  80 #endif  /* CONFIG_CPU_V6 */
  81
  82 #else
  83 #include <mach/debug-macro.S>
  84 #endif  /* CONFIG_DEBUG_ICEDCC */
  85
  86 /*
  87  * Useful debugging routines
  88  */
  89 ENTRY(printhex8)
  90                 mov     r1, #8
  91                 b       printhex
  92
  93 ENTRY(printhex4)
  94                 mov     r1, #4
  95                 b       printhex
  96
  97 ENTRY(printhex2)
  98                 mov     r1, #2
  99 printhex:       adr     r2, hexbuf
 100                 add     r3, r2, r1
 101                 mov     r1, #0
 102                 strb    r1, [r3]
 103 1:              and     r1, r0, #15
 104                 mov     r0, r0, lsr #4
 105                 cmp     r1, #10
 106                 addlt   r1, r1, #'0'
 107                 addge   r1, r1, #'a' - 10
 108                 strb    r1, [r3, #-1]!
 109                 teq     r3, r2
 110                 bne     1b
 111                 mov     r0, r2
 112                 b       printascii
 113
 114                 .ltorg
 115
 116 ENTRY(printascii)
 117                 addruart r3
 118                 b       2f
 119 1:              waituart r2, r3
 120                 senduart r1, r3
 121                 busyuart r2, r3
 122                 teq     r1, #'\n'
 123                 moveq   r1, #'\r'
 124                 beq     1b
 125 2:              teq     r0, #0
 126                 ldrneb  r1, [r0], #1
 127                 teqne   r1, #0
 128                 bne     1b
 129                 mov     pc, lr
 130
 131 ENTRY(printch)
 132                 addruart r3
 133                 mov     r1, r0
 134                 mov     r0, #0
 135                 b       1b
 136
 137 hexbuf:         .space 16