44 lines
		
	
	
		
			1.0 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			44 lines
		
	
	
		
			1.0 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| /*
 | |
|  *  arch/arm/mach-sti/headsmp.S
 | |
|  *
 | |
|  * Copyright (C) 2013 STMicroelectronics (R&D) Limited.
 | |
|  *		http://www.st.com
 | |
|  *
 | |
|  * Cloned from linux/arch/arm/mach-vexpress/headsmp.S
 | |
|  *
 | |
|  *  Copyright (c) 2003 ARM Limited
 | |
|  *  All Rights Reserved
 | |
|  *
 | |
|  * 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.
 | |
|  */
 | |
| #include <linux/linkage.h>
 | |
| #include <linux/init.h>
 | |
| 
 | |
| /*
 | |
|  * ST specific entry point for secondary CPUs.  This provides
 | |
|  * a "holding pen" into which all secondary cores are held until we're
 | |
|  * ready for them to initialise.
 | |
|  */
 | |
| ENTRY(sti_secondary_startup)
 | |
| 	mrc	p15, 0, r0, c0, c0, 5
 | |
| 	and	r0, r0, #15
 | |
| 	adr	r4, 1f
 | |
| 	ldmia	r4, {r5, r6}
 | |
| 	sub	r4, r4, r5
 | |
| 	add	r6, r6, r4
 | |
| pen:	ldr	r7, [r6]
 | |
| 	cmp	r7, r0
 | |
| 	bne	pen
 | |
| 
 | |
| 	/*
 | |
| 	 * we've been released from the holding pen: secondary_stack
 | |
| 	 * should now contain the SVC stack for this core
 | |
| 	 */
 | |
| 	b	secondary_startup
 | |
| ENDPROC(sti_secondary_startup)
 | |
| 
 | |
| 1:	.long	.
 | |
| 	.long	pen_release
 | 
