xref: /openbmc/linux/arch/arm/kernel/debug.S (revision 4e95bc26)
1/* SPDX-License-Identifier: GPL-2.0-only */
2/*
3 *  linux/arch/arm/kernel/debug.S
4 *
5 *  Copyright (C) 1994-1999 Russell King
6 *
7 *  32-bit debugging code
8 */
9#include <linux/linkage.h>
10#include <asm/assembler.h>
11
12		.text
13
14/*
15 * Some debugging routines (useful if you've got MM problems and
16 * printk isn't working).  For DEBUGGING ONLY!!!  Do not leave
17 * references to these in a production kernel!
18 */
19
20#if !defined(CONFIG_DEBUG_SEMIHOSTING)
21#include CONFIG_DEBUG_LL_INCLUDE
22#endif
23
24#ifdef CONFIG_MMU
25		.macro	addruart_current, rx, tmp1, tmp2
26		addruart	\tmp1, \tmp2, \rx
27		mrc		p15, 0, \rx, c1, c0
28		tst		\rx, #1
29		moveq		\rx, \tmp1
30		movne		\rx, \tmp2
31		.endm
32
33#else /* !CONFIG_MMU */
34		.macro	addruart_current, rx, tmp1, tmp2
35		addruart	\rx, \tmp1, \tmp2
36		.endm
37
38#endif /* CONFIG_MMU */
39
40/*
41 * Useful debugging routines
42 */
43ENTRY(printhex8)
44		mov	r1, #8
45		b	printhex
46ENDPROC(printhex8)
47
48ENTRY(printhex4)
49		mov	r1, #4
50		b	printhex
51ENDPROC(printhex4)
52
53ENTRY(printhex2)
54		mov	r1, #2
55printhex:	adr	r2, hexbuf_rel
56		ldr	r3, [r2]
57		add	r2, r2, r3
58		add	r3, r2, r1
59		mov	r1, #0
60		strb	r1, [r3]
611:		and	r1, r0, #15
62		mov	r0, r0, lsr #4
63		cmp	r1, #10
64		addlt	r1, r1, #'0'
65		addge	r1, r1, #'a' - 10
66		strb	r1, [r3, #-1]!
67		teq	r3, r2
68		bne	1b
69		mov	r0, r2
70		b	printascii
71ENDPROC(printhex2)
72
73		.pushsection .bss
74hexbuf_addr:	.space 16
75		.popsection
76		.align
77hexbuf_rel:	.long	hexbuf_addr - .
78
79		.ltorg
80
81#ifndef CONFIG_DEBUG_SEMIHOSTING
82
83ENTRY(printascii)
84		addruart_current r3, r1, r2
851:		teq	r0, #0
86		ldrbne	r1, [r0], #1
87		teqne	r1, #0
88		reteq	lr
892:		teq     r1, #'\n'
90		bne	3f
91		mov	r1, #'\r'
92		waituart r2, r3
93		senduart r1, r3
94		busyuart r2, r3
95		mov	r1, #'\n'
963:		waituart r2, r3
97		senduart r1, r3
98		busyuart r2, r3
99		b	1b
100ENDPROC(printascii)
101
102ENTRY(printch)
103		addruart_current r3, r1, r2
104		mov	r1, r0
105		mov	r0, #0
106		b	2b
107ENDPROC(printch)
108
109#ifdef CONFIG_MMU
110ENTRY(debug_ll_addr)
111		addruart r2, r3, ip
112		str	r2, [r0]
113		str	r3, [r1]
114		ret	lr
115ENDPROC(debug_ll_addr)
116#endif
117
118#else
119
120ENTRY(printascii)
121		mov	r1, r0
122		mov	r0, #0x04		@ SYS_WRITE0
123	ARM(	svc	#0x123456	)
124#ifdef CONFIG_CPU_V7M
125	THUMB(	bkpt	#0xab		)
126#else
127	THUMB(	svc	#0xab		)
128#endif
129		ret	lr
130ENDPROC(printascii)
131
132ENTRY(printch)
133		adr	r1, hexbuf_rel
134		ldr	r2, [r1]
135		add	r1, r1, r2
136		strb	r0, [r1]
137		mov	r0, #0x03		@ SYS_WRITEC
138	ARM(	svc	#0x123456	)
139#ifdef CONFIG_CPU_V7M
140	THUMB(	bkpt	#0xab		)
141#else
142	THUMB(	svc	#0xab		)
143#endif
144		ret	lr
145ENDPROC(printch)
146
147ENTRY(debug_ll_addr)
148		mov	r2, #0
149		str	r2, [r0]
150		str	r2, [r1]
151		ret	lr
152ENDPROC(debug_ll_addr)
153
154#endif
155