137 lines · 2.1 KB · Assembly
RawDownload
/* *  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, rx1001:		mrc	p14, 0, \rx, c0, c1, 0		tst	\rx, #0x20000000		beq	1001b		.endm 		.macro	waituart, rd, rx		mov	\rd, #0x20000001001:		subs	\rd, \rd, #1		bmi	1002f		mrc	p14, 0, \rx, c0, c1, 0		tst	\rx, #0x20000000		bne	1001b1002:		.endm #else 		.macro	addruart, rx		.endm 		.macro	senduart, rd, rx		mcr	p14, 0, \rd, c1, c0, 0		.endm 		.macro	busyuart, rd, rx1001:		mrc	p14, 0, \rx, c0, c0, 0		tst	\rx, #2		beq	1001b 		.endm 		.macro	waituart, rd, rx		mov	\rd, #0x20000001001:		subs	\rd, \rd, #1		bmi	1002f		mrc	p14, 0, \rx, c0, c0, 0		tst	\rx, #2		bne	1001b1002:		.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, #2printhex:	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	2f1:		waituart r2, r3		senduart r1, r3		busyuart r2, r3		teq	r1, #'\n'		moveq	r1, #'\r'		beq	1b2:		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