| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  *  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> | 
					
						
							| 
									
										
										
										
											2012-03-10 10:30:31 -06:00
										 |  |  | #include <asm/assembler.h> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		.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! | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-08-31 00:03:46 -05:00
										 |  |  | #if !defined(CONFIG_DEBUG_SEMIHOSTING) | 
					
						
							|  |  |  | #include CONFIG_DEBUG_LL_INCLUDE | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-07-06 18:30:06 +08:00
										 |  |  | #ifdef CONFIG_MMU | 
					
						
							|  |  |  | 		.macro	addruart_current, rx, tmp1, tmp2 | 
					
						
							| 
									
										
										
										
											2011-08-31 22:55:46 -04:00
										 |  |  | 		addruart	\tmp1, \tmp2, \rx | 
					
						
							| 
									
										
										
										
											2010-07-06 18:30:06 +08:00
										 |  |  | 		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 */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  * Useful debugging routines | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | ENTRY(printhex8) | 
					
						
							|  |  |  | 		mov	r1, #8 | 
					
						
							|  |  |  | 		b	printhex | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(printhex8) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | ENTRY(printhex4) | 
					
						
							|  |  |  | 		mov	r1, #4 | 
					
						
							|  |  |  | 		b	printhex | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(printhex4) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 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 | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(printhex2) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-10-20 19:32:07 +01:00
										 |  |  | hexbuf:		.space 16 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		.ltorg | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-02-22 21:58:03 +01:00
										 |  |  | #ifndef CONFIG_DEBUG_SEMIHOSTING | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | ENTRY(printascii) | 
					
						
							| 
									
										
										
										
											2010-07-06 18:30:06 +08:00
										 |  |  | 		addruart_current r3, r1, r2 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		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 | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(printascii) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | ENTRY(printch) | 
					
						
							| 
									
										
										
										
											2010-07-06 18:30:06 +08:00
										 |  |  | 		addruart_current r3, r1, r2 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		mov	r1, r0 | 
					
						
							|  |  |  | 		mov	r0, #0 | 
					
						
							|  |  |  | 		b	1b | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(printch) | 
					
						
							| 
									
										
										
										
											2012-02-22 21:58:03 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-01-16 15:32:06 +01:00
										 |  |  | #ifdef CONFIG_MMU | 
					
						
							| 
									
										
											  
											
												ARM: implement debug_ll_io_init()
When using DEBUG_LL, the UART's (or other HW's) registers are mapped
into early page tables based on the results of assembly macro addruart.
Later, when the page tables are replaced, the same virtual address must
remain valid. Historically, this has been ensured by using defines from
<mach/iomap.h> in both the implementation of addruart, and the machine's
.map_io() function. However, with the move to single zImage, we wish to
remove <mach/iomap.h>. To enable this, the macro addruart may be used
when constructing the late page tables too; addruart is exposed as a
C function debug_ll_addr(), and used to set up the required mapping in
debug_ll_io_init(), which may called on an opt-in basis from a machine's
.map_io() function.
Signed-off-by: Rob Herring <rob.herring@calxeda.com>
[swarren: Mask map.virtual with PAGE_MASK. Checked for NULL results from
 debug_ll_addr (e.g. when selected UART isn't valid). Fixed compile when
 either !CONFIG_DEBUG_LL or CONFIG_DEBUG_SEMIHOSTING.]
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Olof Johansson <olof@lixom.net>
											
										 
											2012-10-22 11:42:54 -06:00
										 |  |  | ENTRY(debug_ll_addr) | 
					
						
							|  |  |  | 		addruart r2, r3, ip | 
					
						
							|  |  |  | 		str	r2, [r0] | 
					
						
							|  |  |  | 		str	r3, [r1] | 
					
						
							|  |  |  | 		mov	pc, lr | 
					
						
							|  |  |  | ENDPROC(debug_ll_addr) | 
					
						
							| 
									
										
										
										
											2013-01-16 15:32:06 +01:00
										 |  |  | #endif | 
					
						
							| 
									
										
											  
											
												ARM: implement debug_ll_io_init()
When using DEBUG_LL, the UART's (or other HW's) registers are mapped
into early page tables based on the results of assembly macro addruart.
Later, when the page tables are replaced, the same virtual address must
remain valid. Historically, this has been ensured by using defines from
<mach/iomap.h> in both the implementation of addruart, and the machine's
.map_io() function. However, with the move to single zImage, we wish to
remove <mach/iomap.h>. To enable this, the macro addruart may be used
when constructing the late page tables too; addruart is exposed as a
C function debug_ll_addr(), and used to set up the required mapping in
debug_ll_io_init(), which may called on an opt-in basis from a machine's
.map_io() function.
Signed-off-by: Rob Herring <rob.herring@calxeda.com>
[swarren: Mask map.virtual with PAGE_MASK. Checked for NULL results from
 debug_ll_addr (e.g. when selected UART isn't valid). Fixed compile when
 either !CONFIG_DEBUG_LL or CONFIG_DEBUG_SEMIHOSTING.]
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Olof Johansson <olof@lixom.net>
											
										 
											2012-10-22 11:42:54 -06:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-02-22 21:58:03 +01:00
										 |  |  | #else | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | ENTRY(printascii) | 
					
						
							|  |  |  | 		mov	r1, r0 | 
					
						
							|  |  |  | 		mov	r0, #0x04		@ SYS_WRITE0
 | 
					
						
							|  |  |  | 	ARM(	svc	#0x123456	) | 
					
						
							|  |  |  | 	THUMB(	svc	#0xab		) | 
					
						
							|  |  |  | 		mov	pc, lr | 
					
						
							|  |  |  | ENDPROC(printascii) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | ENTRY(printch) | 
					
						
							|  |  |  | 		adr	r1, hexbuf | 
					
						
							|  |  |  | 		strb	r0, [r1] | 
					
						
							|  |  |  | 		mov	r0, #0x03		@ SYS_WRITEC
 | 
					
						
							|  |  |  | 	ARM(	svc	#0x123456	) | 
					
						
							|  |  |  | 	THUMB(	svc	#0xab		) | 
					
						
							|  |  |  | 		mov	pc, lr | 
					
						
							|  |  |  | ENDPROC(printch) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
											  
											
												ARM: implement debug_ll_io_init()
When using DEBUG_LL, the UART's (or other HW's) registers are mapped
into early page tables based on the results of assembly macro addruart.
Later, when the page tables are replaced, the same virtual address must
remain valid. Historically, this has been ensured by using defines from
<mach/iomap.h> in both the implementation of addruart, and the machine's
.map_io() function. However, with the move to single zImage, we wish to
remove <mach/iomap.h>. To enable this, the macro addruart may be used
when constructing the late page tables too; addruart is exposed as a
C function debug_ll_addr(), and used to set up the required mapping in
debug_ll_io_init(), which may called on an opt-in basis from a machine's
.map_io() function.
Signed-off-by: Rob Herring <rob.herring@calxeda.com>
[swarren: Mask map.virtual with PAGE_MASK. Checked for NULL results from
 debug_ll_addr (e.g. when selected UART isn't valid). Fixed compile when
 either !CONFIG_DEBUG_LL or CONFIG_DEBUG_SEMIHOSTING.]
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Olof Johansson <olof@lixom.net>
											
										 
											2012-10-22 11:42:54 -06:00
										 |  |  | ENTRY(debug_ll_addr) | 
					
						
							|  |  |  | 		mov	r2, #0 | 
					
						
							|  |  |  | 		str	r2, [r0] | 
					
						
							|  |  |  | 		str	r2, [r1] | 
					
						
							|  |  |  | 		mov	pc, lr | 
					
						
							|  |  |  | ENDPROC(debug_ll_addr) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-02-22 21:58:03 +01:00
										 |  |  | #endif |