[mirror_ubuntu-artful-kernel.git] / arch / mips / netlogic / common / smpboot.S

/*
 * Copyright 2003-2011 NetLogic Microsystems, Inc. (NetLogic). All rights
 * reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the NetLogic
 * license below:
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY NETLOGIC ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */


#include <asm/asm.h>
#include <asm/asm-offsets.h>
#include <asm/regdef.h>
#include <asm/mipsregs.h>
#include <asm/stackframe.h>
#include <asm/asmmacro.h>
#include <asm/addrspace.h>

#include <asm/netlogic/common.h>

#include <asm/netlogic/xlp-hal/iomap.h>
#include <asm/netlogic/xlp-hal/xlp.h>
#include <asm/netlogic/xlp-hal/sys.h>
#include <asm/netlogic/xlp-hal/cpucontrol.h>

	.set	noreorder
	.set	noat
	.set	arch=xlr		/* for mfcr/mtcr, XLR is sufficient */

/* Called by the boot cpu to wake up its sibling threads */
NESTED(xlp_boot_core0_siblings, PT_SIZE, sp)
	/* CPU register contents lost when enabling threads, save them first */
	SAVE_ALL
	sync
	/* find the location to which nlm_boot_siblings was relocated */
	li	t0, CKSEG1ADDR(RESET_VEC_PHYS)
	PTR_LA	t1, nlm_reset_entry
	PTR_LA	t2, nlm_boot_siblings
	dsubu	t2, t1
	daddu	t2, t0
	/* call it */
	jalr	t2
	nop
	RESTORE_ALL
	jr	ra
	nop
END(xlp_boot_core0_siblings)

NESTED(nlm_boot_secondary_cpus, 16, sp)
	/* Initialize CP0 Status */
	move	t1, zero
#ifdef CONFIG_64BIT
	ori	t1, ST0_KX
#endif
	mtc0	t1, CP0_STATUS
	PTR_LA	t1, nlm_next_sp
	PTR_L	sp, 0(t1)
	PTR_LA	t1, nlm_next_gp
	PTR_L	gp, 0(t1)

	/* a0 has the processor id */
	mfc0	a0, CP0_EBASE
	andi	a0, 0x3ff		/* a0 <- node/core */
	PTR_LA	t0, nlm_early_init_secondary
	jalr	t0
	nop

	PTR_LA	t0, smp_bootstrap
	jr	t0
	nop
END(nlm_boot_secondary_cpus)

/*
 * In case of RMIboot bootloader which is used on XLR boards, the CPUs
 * be already woken up and waiting in bootloader code.
 * This will get them out of the bootloader code and into linux. Needed
 * because the bootloader area will be taken and initialized by linux.
 */
NESTED(nlm_rmiboot_preboot, 16, sp)
	mfc0	t0, $15, 1	/* read ebase */
	andi	t0, 0x1f	/* t0 has the processor_id() */
	andi	t2, t0, 0x3	/* thread num */
	sll	t0, 2		/* offset in cpu array */

	li	t3, CKSEG1ADDR(RESET_DATA_PHYS)
	ADDIU	t1, t3, BOOT_CPU_READY
	ADDU	t1, t0
	li	t3, 1
	sw	t3, 0(t1)

	bnez	t2, 1f		/* skip thread programming */
	nop			/* for thread id != 0 */

	/*
	 * XLR MMU setup only for first thread in core
	 */
	li	t0, 0x400
	mfcr	t1, t0
	li	t2, 6		/* XLR thread mode mask */
	nor	t3, t2, zero
	and	t2, t1, t2	/* t2 - current thread mode */
	li	v0, CKSEG1ADDR(RESET_DATA_PHYS)
	lw	v1, BOOT_THREAD_MODE(v0) /* v1 - new thread mode */
	sll	v1, 1
	beq	v1, t2, 1f	/* same as request value */
	nop			/* nothing to do */

	and	t2, t1, t3	/* mask out old thread mode */
	or	t1, t2, v1	/* put in new value */
	mtcr	t1, t0		/* update core control */

	/* wait for NMI to hit */
1:	wait
	b	1b
	nop
END(nlm_rmiboot_preboot)
Commit	Line	Data
65040e22 J	1	/*
	2	* Copyright 2003-2011 NetLogic Microsystems, Inc. (NetLogic). All rights
	3	* reserved.
	4	*
	5	* This software is available to you under a choice of one of two
	6	* licenses. You may choose to be licensed under the terms of the GNU
	7	* General Public License (GPL) Version 2, available from the file
	8	* COPYING in the main directory of this source tree, or the NetLogic
	9	* license below:
	10	*
	11	* Redistribution and use in source and binary forms, with or without
	12	* modification, are permitted provided that the following conditions
	13	* are met:
	14	*
	15	* 1. Redistributions of source code must retain the above copyright
	16	* notice, this list of conditions and the following disclaimer.
	17	* 2. Redistributions in binary form must reproduce the above copyright
	18	* notice, this list of conditions and the following disclaimer in
	19	* the documentation and/or other materials provided with the
	20	* distribution.
	21	*
	22	* THIS SOFTWARE IS PROVIDED BY NETLOGIC ``AS IS'' AND ANY EXPRESS OR
	23	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
	24	* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	25	* ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE LIABLE
	26	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
	27	* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
	28	* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
	29	* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
	30	* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
	31	* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
	32	* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	33	*/
	34
65040e22 J	35
	36	#include <asm/asm.h>
	37	#include <asm/asm-offsets.h>
	38	#include <asm/regdef.h>
	39	#include <asm/mipsregs.h>
	40	#include <asm/stackframe.h>
	41	#include <asm/asmmacro.h>
	42	#include <asm/addrspace.h>
	43
66d29985 J	44	#include <asm/netlogic/common.h>
66d29985 J	45
65040e22 J	46	#include <asm/netlogic/xlp-hal/iomap.h>
	47	#include <asm/netlogic/xlp-hal/xlp.h>
	48	#include <asm/netlogic/xlp-hal/sys.h>
	49	#include <asm/netlogic/xlp-hal/cpucontrol.h>
	50
65040e22	51	.set noreorder
66d29985	52	.set noat
9584c55a	53	.set arch=xlr /* for mfcr/mtcr, XLR is sufficient */
65040e22	54
a3deecfa J	55	/* Called by the boot cpu to wake up its sibling threads */
	56	NESTED(xlp_boot_core0_siblings, PT_SIZE, sp)
	57	/* CPU register contents lost when enabling threads, save them first */
65040e22 J	58	SAVE_ALL
	59	sync
	60	/* find the location to which nlm_boot_siblings was relocated */
	61	li t0, CKSEG1ADDR(RESET_VEC_PHYS)
a8b3b0c9 PB	62	PTR_LA t1, nlm_reset_entry
a8b3b0c9 PB	63	PTR_LA t2, nlm_boot_siblings
65040e22 J	64	dsubu t2, t1
	65	daddu t2, t0
	66	/* call it */
a3deecfa	67	jalr t2
65040e22	68	nop
a3deecfa J	69	RESTORE_ALL
	70	jr ra
	71	nop
	72	END(xlp_boot_core0_siblings)
65040e22	73
66d29985	74	NESTED(nlm_boot_secondary_cpus, 16, sp)
51d1eac0 J	75	/* Initialize CP0 Status */
	76	move t1, zero
	77	#ifdef CONFIG_64BIT
	78	ori t1, ST0_KX
	79	#endif
	80	mtc0 t1, CP0_STATUS
66d29985	81	PTR_LA t1, nlm_next_sp
65040e22 J	82	PTR_L sp, 0(t1)
	83	PTR_LA t1, nlm_next_gp
	84	PTR_L gp, 0(t1)
	85
	86	/* a0 has the processor id */
32eb6e8b	87	mfc0 a0, CP0_EBASE
feddaf7d	88	andi a0, 0x3ff /* a0 <- node/core */
65040e22 J	89	PTR_LA t0, nlm_early_init_secondary
	90	jalr t0
	91	nop
	92
	93	PTR_LA t0, smp_bootstrap
	94	jr t0
	95	nop
66d29985	96	END(nlm_boot_secondary_cpus)
66d29985 J	97
	98	/*
	99	* In case of RMIboot bootloader which is used on XLR boards, the CPUs
	100	* be already woken up and waiting in bootloader code.
	101	* This will get them out of the bootloader code and into linux. Needed
d3b94285	102	* because the bootloader area will be taken and initialized by linux.
66d29985	103	*/
66d29985	104	NESTED(nlm_rmiboot_preboot, 16, sp)
cedc8ef8 J	105	mfc0 t0, $15, 1 /* read ebase */
	106	andi t0, 0x1f /* t0 has the processor_id() */
	107	andi t2, t0, 0x3 /* thread num */
	108	sll t0, 2 /* offset in cpu array */
66d29985	109
919f9abb J	110	li t3, CKSEG1ADDR(RESET_DATA_PHYS)
	111	ADDIU t1, t3, BOOT_CPU_READY
	112	ADDU t1, t0
66d29985 J	113	li t3, 1
	114	sw t3, 0(t1)
	115
cedc8ef8 J	116	bnez t2, 1f /* skip thread programming */
cedc8ef8 J	117	nop /* for thread id != 0 */
66d29985 J	118
66d29985 J	119	/*
cedc8ef8	120	* XLR MMU setup only for first thread in core
66d29985 J	121	*/
	122	li t0, 0x400
	123	mfcr t1, t0
70342287	124	li t2, 6 /* XLR thread mode mask */
66d29985	125	nor t3, t2, zero
cedc8ef8	126	and t2, t1, t2 /* t2 - current thread mode */
66d29985	127	li v0, CKSEG1ADDR(RESET_DATA_PHYS)
cedc8ef8	128	lw v1, BOOT_THREAD_MODE(v0) /* v1 - new thread mode */
66d29985	129	sll v1, 1
70342287	130	beq v1, t2, 1f /* same as request value */
cedc8ef8	131	nop /* nothing to do */
66d29985	132
cedc8ef8 J	133	and t2, t1, t3 /* mask out old thread mode */
	134	or t1, t2, v1 /* put in new value */
	135	mtcr t1, t0 /* update core control */
66d29985	136
d3b94285	137	/* wait for NMI to hit */
66d29985	138	1: wait
fd5f527c	139	b 1b
66d29985 J	140	nop
66d29985 J	141	END(nlm_rmiboot_preboot)