145 lines
		
	
	
		
			2.9 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			145 lines
		
	
	
		
			2.9 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| /*
 | |
|  * Copyright (C) 2000 Anton Blanchard (anton@linuxcare.com)
 | |
|  *
 | |
|  * This file implements mcount(), which is used to collect profiling data.
 | |
|  * This can also be tweaked for kernel stack overflow detection.
 | |
|  */
 | |
| 
 | |
| #include <linux/linkage.h>
 | |
| 
 | |
| #include <asm/ptrace.h>
 | |
| #include <asm/thread_info.h>
 | |
| 
 | |
| /*
 | |
|  * This is the main variant and is called by C code.  GCC's -pg option
 | |
|  * automatically instruments every C function with a call to this.
 | |
|  */
 | |
| 
 | |
| #ifdef CONFIG_STACK_DEBUG
 | |
| 
 | |
| #define OVSTACKSIZE	4096		/* lets hope this is enough */
 | |
| 
 | |
| 	.data
 | |
| 	.align		8
 | |
| panicstring:
 | |
| 	.asciz		"Stack overflow\n"
 | |
| 	.align		8
 | |
| ovstack:
 | |
| 	.skip		OVSTACKSIZE
 | |
| #endif
 | |
| 	.text
 | |
| 	.align		32
 | |
| 	.globl		_mcount
 | |
| 	.type		_mcount,#function
 | |
| 	.globl		mcount
 | |
| 	.type		mcount,#function
 | |
| _mcount:
 | |
| mcount:
 | |
| #ifdef CONFIG_STACK_DEBUG
 | |
| 	/*
 | |
| 	 * Check whether %sp is dangerously low.
 | |
| 	 */
 | |
| 	ldub		[%g6 + TI_FPDEPTH], %g1
 | |
| 	srl		%g1, 1, %g3
 | |
| 	add		%g3, 1, %g3
 | |
| 	sllx		%g3, 8, %g3			! each fpregs frame is 256b
 | |
| 	add		%g3, 192, %g3
 | |
| 	add		%g6, %g3, %g3			! where does task_struct+frame end?
 | |
| 	sub		%g3, STACK_BIAS, %g3
 | |
| 	cmp		%sp, %g3
 | |
| 	bg,pt		%xcc, 1f
 | |
| 	 nop
 | |
| 	lduh		[%g6 + TI_CPU], %g1
 | |
| 	sethi		%hi(hardirq_stack), %g3
 | |
| 	or		%g3, %lo(hardirq_stack), %g3
 | |
| 	sllx		%g1, 3, %g1
 | |
| 	ldx		[%g3 + %g1], %g7
 | |
| 	sub		%g7, STACK_BIAS, %g7
 | |
| 	cmp		%sp, %g7
 | |
| 	bleu,pt		%xcc, 2f
 | |
| 	 sethi		%hi(THREAD_SIZE), %g3
 | |
| 	add		%g7, %g3, %g7
 | |
| 	cmp		%sp, %g7
 | |
| 	blu,pn		%xcc, 1f
 | |
| 2:	 sethi		%hi(softirq_stack), %g3
 | |
| 	or		%g3, %lo(softirq_stack), %g3
 | |
| 	ldx		[%g3 + %g1], %g7
 | |
| 	sub		%g7, STACK_BIAS, %g7
 | |
| 	cmp		%sp, %g7
 | |
| 	bleu,pt		%xcc, 3f
 | |
| 	 sethi		%hi(THREAD_SIZE), %g3
 | |
| 	add		%g7, %g3, %g7
 | |
| 	cmp		%sp, %g7
 | |
| 	blu,pn		%xcc, 1f
 | |
| 	 nop
 | |
| 	/* If we are already on ovstack, don't hop onto it
 | |
| 	 * again, we are already trying to output the stack overflow
 | |
| 	 * message.
 | |
| 	 */
 | |
| 3:	sethi		%hi(ovstack), %g7		! cant move to panic stack fast enough
 | |
| 	 or		%g7, %lo(ovstack), %g7
 | |
| 	add		%g7, OVSTACKSIZE, %g3
 | |
| 	sub		%g3, STACK_BIAS + 192, %g3
 | |
| 	sub		%g7, STACK_BIAS, %g7
 | |
| 	cmp		%sp, %g7
 | |
| 	blu,pn		%xcc, 2f
 | |
| 	 cmp		%sp, %g3
 | |
| 	bleu,pn		%xcc, 1f
 | |
| 	 nop
 | |
| 2:	mov		%g3, %sp
 | |
| 	sethi		%hi(panicstring), %g3
 | |
| 	call		prom_printf
 | |
| 	 or		%g3, %lo(panicstring), %o0
 | |
| 	call		prom_halt
 | |
| 	 nop
 | |
| 1:
 | |
| #endif
 | |
| #ifdef CONFIG_FUNCTION_TRACER
 | |
| #ifdef CONFIG_DYNAMIC_FTRACE
 | |
| 	mov		%o7, %o0
 | |
| 	.globl		mcount_call
 | |
| mcount_call:
 | |
| 	call		ftrace_stub
 | |
| 	 mov		%o0, %o7
 | |
| #else
 | |
| 	sethi		%hi(ftrace_trace_function), %g1
 | |
| 	sethi		%hi(ftrace_stub), %g2
 | |
| 	ldx		[%g1 + %lo(ftrace_trace_function)], %g1
 | |
| 	or		%g2, %lo(ftrace_stub), %g2
 | |
| 	cmp		%g1, %g2
 | |
| 	be,pn		%icc, 1f
 | |
| 	 mov		%i7, %o1
 | |
| 	jmpl		%g1, %g0
 | |
| 	 mov		%o7, %o0
 | |
| 	/* not reached */
 | |
| 1:
 | |
| #endif
 | |
| #endif
 | |
| 	retl
 | |
| 	 nop
 | |
| 	.size		_mcount,.-_mcount
 | |
| 	.size		mcount,.-mcount
 | |
| 
 | |
| #ifdef CONFIG_FUNCTION_TRACER
 | |
| 	.globl		ftrace_stub
 | |
| 	.type		ftrace_stub,#function
 | |
| ftrace_stub:
 | |
| 	retl
 | |
| 	 nop
 | |
| 	.size		ftrace_stub,.-ftrace_stub
 | |
| #ifdef CONFIG_DYNAMIC_FTRACE
 | |
| 	.globl		ftrace_caller
 | |
| 	.type		ftrace_caller,#function
 | |
| ftrace_caller:
 | |
| 	mov		%i7, %o1
 | |
| 	mov		%o7, %o0
 | |
| 	.globl		ftrace_call
 | |
| ftrace_call:
 | |
| 	call		ftrace_stub
 | |
| 	 mov		%o0, %o7
 | |
| 	retl
 | |
| 	 nop
 | |
| 	.size		ftrace_caller,.-ftrace_caller
 | |
| #endif
 | |
| #endif
 |