[linux-2.6] / 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

#if defined(CONFIG_CPU_V6)

		.macro	addruart, rx
		.endm

		.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

#else

		.macro	addruart, rx
		.endm

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

/*
 * 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 r3
		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 r3
		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 TL	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
1da177e4 LT	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
7d95ded9 TL	79
	80	#endif /* CONFIG_CPU_V6 */
	81
1da177e4	82	#else
a09e64fb	83	#include <mach/debug-macro.S>
7d95ded9	84	#endif /* CONFIG_DEBUG_ICEDCC */
1da177e4 LT	85
	86	/*
	87	* Useful debugging routines
	88	*/
	89	ENTRY(printhex8)
	90	mov r1, #8
	91	b printhex
93ed3970	92	ENDPROC(printhex8)
1da177e4 LT	93
	94	ENTRY(printhex4)
	95	mov r1, #4
	96	b printhex
93ed3970	97	ENDPROC(printhex4)
1da177e4 LT	98
	99	ENTRY(printhex2)
	100	mov r1, #2
	101	printhex: adr r2, hexbuf
	102	add r3, r2, r1
	103	mov r1, #0
	104	strb r1, [r3]
	105	1: and r1, r0, #15
	106	mov r0, r0, lsr #4
	107	cmp r1, #10
	108	addlt r1, r1, #'0'
	109	addge r1, r1, #'a' - 10
	110	strb r1, [r3, #-1]!
	111	teq r3, r2
	112	bne 1b
	113	mov r0, r2
	114	b printascii
93ed3970	115	ENDPROC(printhex2)
1da177e4 LT	116
	117	.ltorg
	118
	119	ENTRY(printascii)
	120	addruart r3
	121	b 2f
	122	1: waituart r2, r3
	123	senduart r1, r3
	124	busyuart r2, r3
	125	teq r1, #'\n'
	126	moveq r1, #'\r'
	127	beq 1b
	128	2: teq r0, #0
	129	ldrneb r1, [r0], #1
	130	teqne r1, #0
	131	bne 1b
	132	mov pc, lr
93ed3970	133	ENDPROC(printascii)
1da177e4 LT	134
	135	ENTRY(printch)
	136	addruart r3
	137	mov r1, r0
	138	mov r0, #0
	139	b 1b
93ed3970	140	ENDPROC(printch)
1da177e4 LT	141
1da177e4 LT	142	hexbuf: .space 16