[deliverable/linux.git] / arch / arm / kernel / debug.S

/*
 *  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)

		.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)

hexbuf:		.space 16
Commit	Line	Data
1da177e4 LT	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	*/
1da177e4	12	#include <linux/linkage.h>
1da177e4 LT	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
7d95ded9	24
0ea12930	25	.macro addruart, rp, rv
7d95ded9 TL	26	.endm
7d95ded9 TL	27
dfad549d	28	#if defined(CONFIG_CPU_V6) \|\| defined(CONFIG_CPU_V6K) \|\| defined(CONFIG_CPU_V7)
1ea64615	29
7d95ded9 TL	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
c633c3cf JCPV	52	#elif defined(CONFIG_CPU_XSCALE)
c633c3cf JCPV	53
c633c3cf JCPV	54	.macro senduart, rd, rx
	55	mcr p14, 0, \rd, c8, c0, 0
	56	.endm
	57
	58	.macro busyuart, rd, rx
	59	1001:
	60	mrc p14, 0, \rx, c14, c0, 0
	61	tst \rx, #0x10000000
	62	beq 1001b
	63	.endm
	64
	65	.macro waituart, rd, rx
	66	mov \rd, #0x10000000
	67	1001:
	68	subs \rd, \rd, #1
	69	bmi 1002f
	70	mrc p14, 0, \rx, c14, c0, 0
	71	tst \rx, #0x10000000
	72	bne 1001b
	73	1002:
	74	.endm
	75
7d95ded9 TL	76	#else
7d95ded9 TL	77
1da177e4 LT	78	.macro senduart, rd, rx
	79	mcr p14, 0, \rd, c1, c0, 0
	80	.endm
	81
	82	.macro busyuart, rd, rx
	83	1001:
	84	mrc p14, 0, \rx, c0, c0, 0
	85	tst \rx, #2
	86	beq 1001b
	87
	88	.endm
	89
	90	.macro waituart, rd, rx
	91	mov \rd, #0x2000000
	92	1001:
	93	subs \rd, \rd, #1
	94	bmi 1002f
	95	mrc p14, 0, \rx, c0, c0, 0
	96	tst \rx, #2
	97	bne 1001b
	98	1002:
	99	.endm
7d95ded9 TL	100
	101	#endif /* CONFIG_CPU_V6 */
	102
1da177e4	103	#else
a09e64fb	104	#include <mach/debug-macro.S>
7d95ded9	105	#endif /* CONFIG_DEBUG_ICEDCC */
1da177e4	106
0ea12930 JK	107	#ifdef CONFIG_MMU
	108	.macro addruart_current, rx, tmp1, tmp2
	109	addruart \tmp1, \tmp2
	110	mrc p15, 0, \rx, c1, c0
	111	tst \rx, #1
	112	moveq \rx, \tmp1
	113	movne \rx, \tmp2
	114	.endm
	115
	116	#else /* !CONFIG_MMU */
	117	.macro addruart_current, rx, tmp1, tmp2
	118	addruart \rx, \tmp1
	119	.endm
	120
	121	#endif /* CONFIG_MMU */
	122
1da177e4 LT	123	/*
	124	* Useful debugging routines
	125	*/
	126	ENTRY(printhex8)
	127	mov r1, #8
	128	b printhex
93ed3970	129	ENDPROC(printhex8)
1da177e4 LT	130
	131	ENTRY(printhex4)
	132	mov r1, #4
	133	b printhex
93ed3970	134	ENDPROC(printhex4)
1da177e4 LT	135
	136	ENTRY(printhex2)
	137	mov r1, #2
	138	printhex: adr r2, hexbuf
	139	add r3, r2, r1
	140	mov r1, #0
	141	strb r1, [r3]
	142	1: and r1, r0, #15
	143	mov r0, r0, lsr #4
	144	cmp r1, #10
	145	addlt r1, r1, #'0'
	146	addge r1, r1, #'a' - 10
	147	strb r1, [r3, #-1]!
	148	teq r3, r2
	149	bne 1b
	150	mov r0, r2
	151	b printascii
93ed3970	152	ENDPROC(printhex2)
1da177e4 LT	153
	154	.ltorg
	155
	156	ENTRY(printascii)
0ea12930	157	addruart_current r3, r1, r2
1da177e4 LT	158	b 2f
	159	1: waituart r2, r3
	160	senduart r1, r3
	161	busyuart r2, r3
	162	teq r1, #'\n'
	163	moveq r1, #'\r'
	164	beq 1b
	165	2: teq r0, #0
	166	ldrneb r1, [r0], #1
	167	teqne r1, #0
	168	bne 1b
	169	mov pc, lr
93ed3970	170	ENDPROC(printascii)
1da177e4 LT	171
1da177e4 LT	172	ENTRY(printch)
0ea12930	173	addruart_current r3, r1, r2
1da177e4 LT	174	mov r1, r0
	175	mov r0, #0
	176	b 1b
93ed3970	177	ENDPROC(printch)
1da177e4 LT	178
1da177e4 LT	179	hexbuf: .space 16