[net-next-2.6.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

#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 <asm/arch/debug-macro.S>
#endif	/* CONFIG_DEBUG_ICEDCC */

/*
 * Useful debugging routines
 */
ENTRY(printhex8)
		mov	r1, #8
		b	printhex

ENTRY(printhex4)
		mov	r1, #4
		b	printhex

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

		.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

ENTRY(printch)
		addruart r3
		mov	r1, r0
		mov	r0, #0
		b	1b

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 LT	82	#else
1da177e4 LT	83	#include <asm/arch/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
	92
	93	ENTRY(printhex4)
	94	mov r1, #4
	95	b printhex
	96
	97	ENTRY(printhex2)
	98	mov r1, #2
	99	printhex: adr r2, hexbuf
	100	add r3, r2, r1
	101	mov r1, #0
	102	strb r1, [r3]
	103	1: and r1, r0, #15
	104	mov r0, r0, lsr #4
	105	cmp r1, #10
	106	addlt r1, r1, #'0'
	107	addge r1, r1, #'a' - 10
	108	strb r1, [r3, #-1]!
	109	teq r3, r2
	110	bne 1b
	111	mov r0, r2
	112	b printascii
	113
	114	.ltorg
	115
	116	ENTRY(printascii)
	117	addruart r3
	118	b 2f
	119	1: waituart r2, r3
	120	senduart r1, r3
	121	busyuart r2, r3
	122	teq r1, #'\n'
	123	moveq r1, #'\r'
	124	beq 1b
	125	2: teq r0, #0
	126	ldrneb r1, [r0], #1
	127	teqne r1, #0
	128	bne 1b
	129	mov pc, lr
	130
	131	ENTRY(printch)
	132	addruart r3
	133	mov r1, r0
	134	mov r0, #0
	135	b 1b
	136
	137	hexbuf: .space 16