mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
161 lines
2.6 KiB
161 lines
2.6 KiB
/* SPDX-License-Identifier: GPL-2.0-only */ |
|
/* |
|
* linux/arch/arm/kernel/debug.S |
|
* |
|
* Copyright (C) 1994-1999 Russell King |
|
* |
|
* 32-bit debugging code |
|
*/ |
|
#include <linux/linkage.h> |
|
#include <asm/assembler.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_SEMIHOSTING) |
|
#include CONFIG_DEBUG_LL_INCLUDE |
|
#endif |
|
|
|
#ifdef CONFIG_MMU |
|
.macro addruart_current, rx, tmp1, tmp2 |
|
addruart \tmp1, \tmp2, \rx |
|
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, \tmp2 |
|
.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_rel |
|
ldr r3, [r2] |
|
add r2, r2, r3 |
|
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) |
|
|
|
.pushsection .bss |
|
hexbuf_addr: .space 16 |
|
.popsection |
|
.align |
|
hexbuf_rel: .long hexbuf_addr - . |
|
|
|
.ltorg |
|
|
|
#ifndef CONFIG_DEBUG_SEMIHOSTING |
|
|
|
ENTRY(printascii) |
|
addruart_current r3, r1, r2 |
|
1: teq r0, #0 |
|
ldrbne r1, [r0], #1 |
|
teqne r1, #0 |
|
reteq lr |
|
2: teq r1, #'\n' |
|
bne 3f |
|
mov r1, #'\r' |
|
#ifdef CONFIG_DEBUG_UART_FLOW_CONTROL |
|
waituartcts r2, r3 |
|
#endif |
|
waituarttxrdy r2, r3 |
|
senduart r1, r3 |
|
busyuart r2, r3 |
|
mov r1, #'\n' |
|
3: |
|
#ifdef CONFIG_DEBUG_UART_FLOW_CONTROL |
|
waituartcts r2, r3 |
|
#endif |
|
waituarttxrdy r2, r3 |
|
senduart r1, r3 |
|
busyuart r2, r3 |
|
b 1b |
|
ENDPROC(printascii) |
|
|
|
ENTRY(printch) |
|
addruart_current r3, r1, r2 |
|
mov r1, r0 |
|
mov r0, #0 |
|
b 2b |
|
ENDPROC(printch) |
|
|
|
#ifdef CONFIG_MMU |
|
ENTRY(debug_ll_addr) |
|
addruart r2, r3, ip |
|
str r2, [r0] |
|
str r3, [r1] |
|
ret lr |
|
ENDPROC(debug_ll_addr) |
|
#endif |
|
|
|
#else |
|
|
|
ENTRY(printascii) |
|
mov r1, r0 |
|
mov r0, #0x04 @ SYS_WRITE0 |
|
ARM( svc #0x123456 ) |
|
#ifdef CONFIG_CPU_V7M |
|
THUMB( bkpt #0xab ) |
|
#else |
|
THUMB( svc #0xab ) |
|
#endif |
|
ret lr |
|
ENDPROC(printascii) |
|
|
|
ENTRY(printch) |
|
adr r1, hexbuf_rel |
|
ldr r2, [r1] |
|
add r1, r1, r2 |
|
strb r0, [r1] |
|
mov r0, #0x03 @ SYS_WRITEC |
|
ARM( svc #0x123456 ) |
|
#ifdef CONFIG_CPU_V7M |
|
THUMB( bkpt #0xab ) |
|
#else |
|
THUMB( svc #0xab ) |
|
#endif |
|
ret lr |
|
ENDPROC(printch) |
|
|
|
ENTRY(debug_ll_addr) |
|
mov r2, #0 |
|
str r2, [r0] |
|
str r2, [r1] |
|
ret lr |
|
ENDPROC(debug_ll_addr) |
|
|
|
#endif
|
|
|