debug.S 2.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136
  1. /*
  2. * linux/arch/arm/kernel/debug.S
  3. *
  4. * Copyright (C) 1994-1999 Russell King
  5. *
  6. * SPDX-License-Identifier: GPL-2.0+
  7. *
  8. * 32-bit debugging code
  9. */
  10. #include <linux/linkage.h>
  11. #include <asm/assembler.h>
  12. .text
  13. /*
  14. * Some debugging routines (useful if you've got MM problems and
  15. * printk isn't working). For DEBUGGING ONLY!!! Do not leave
  16. * references to these in a production kernel!
  17. */
  18. #if !defined(CONFIG_DEBUG_SEMIHOSTING)
  19. #include CONFIG_DEBUG_LL_INCLUDE
  20. #endif
  21. #ifdef CONFIG_MMU
  22. .macro addruart_current, rx, tmp1, tmp2
  23. addruart \tmp1, \tmp2, \rx
  24. mrc p15, 0, \rx, c1, c0
  25. tst \rx, #1
  26. moveq \rx, \tmp1
  27. movne \rx, \tmp2
  28. .endm
  29. #else /* !CONFIG_MMU */
  30. .macro addruart_current, rx, tmp1, tmp2
  31. addruart \rx, \tmp1, \tmp2
  32. .endm
  33. #endif /* CONFIG_MMU */
  34. /*
  35. * Useful debugging routines
  36. */
  37. ENTRY(printhex8)
  38. mov r1, #8
  39. b printhex
  40. ENDPROC(printhex8)
  41. ENTRY(printhex4)
  42. mov r1, #4
  43. b printhex
  44. ENDPROC(printhex4)
  45. ENTRY(printhex2)
  46. mov r1, #2
  47. printhex: adr r2, hexbuf
  48. add r3, r2, r1
  49. mov r1, #0
  50. strb r1, [r3]
  51. 1: and r1, r0, #15
  52. mov r0, r0, lsr #4
  53. cmp r1, #10
  54. addlt r1, r1, #'0'
  55. addge r1, r1, #'a' - 10
  56. strb r1, [r3, #-1]!
  57. teq r3, r2
  58. bne 1b
  59. mov r0, r2
  60. b printascii
  61. ENDPROC(printhex2)
  62. hexbuf: .space 16
  63. .ltorg
  64. #ifndef CONFIG_DEBUG_SEMIHOSTING
  65. ENTRY(printascii)
  66. addruart_current r3, r1, r2
  67. b 2f
  68. 1: waituart r2, r3
  69. senduart r1, r3
  70. busyuart r2, r3
  71. teq r1, #'\n'
  72. moveq r1, #'\r'
  73. beq 1b
  74. 2: teq r0, #0
  75. ldrneb r1, [r0], #1
  76. teqne r1, #0
  77. bne 1b
  78. mov pc, lr
  79. ENDPROC(printascii)
  80. ENTRY(printch)
  81. addruart_current r3, r1, r2
  82. mov r1, r0
  83. mov r0, #0
  84. b 1b
  85. ENDPROC(printch)
  86. #ifdef CONFIG_MMU
  87. ENTRY(debug_ll_addr)
  88. addruart r2, r3, ip
  89. str r2, [r0]
  90. str r3, [r1]
  91. mov pc, lr
  92. ENDPROC(debug_ll_addr)
  93. #endif
  94. #else
  95. ENTRY(printascii)
  96. mov r1, r0
  97. mov r0, #0x04 @ SYS_WRITE0
  98. ARM( svc #0x123456 )
  99. THUMB( svc #0xab )
  100. mov pc, lr
  101. ENDPROC(printascii)
  102. ENTRY(printch)
  103. adr r1, hexbuf
  104. strb r0, [r1]
  105. mov r0, #0x03 @ SYS_WRITEC
  106. ARM( svc #0x123456 )
  107. THUMB( svc #0xab )
  108. mov pc, lr
  109. ENDPROC(printch)
  110. ENTRY(debug_ll_addr)
  111. mov r2, #0
  112. str r2, [r0]
  113. str r2, [r1]
  114. mov pc, lr
  115. ENDPROC(debug_ll_addr)
  116. #endif