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
35#include <asm/asm.h>
36#include <asm/asm-offsets.h>
37#include <asm/regdef.h>
38#include <asm/mipsregs.h>
39
40
41/* Don't jump to linux function from Bootloader stack. Change it
42 * here. Kernel might allocate bootloader memory before all the CPUs are
43 * brought up (eg: Inode cache region) and we better don't overwrite this
44 * memory
45 */
46NESTED(prom_pre_boot_secondary_cpus, 16, sp)
47	.set	mips64
48	mfc0	t0, $15, 1	# read ebase
49	andi	t0, 0x1f	# t0 has the processor_id()
50	sll	t0, 2		# offset in cpu array
51
52	PTR_LA	t1, nlm_cpu_ready # mark CPU ready
53	PTR_ADDU t1, t0
54	li	t2, 1
55	sw	t2, 0(t1)
56
57	PTR_LA	t1, nlm_cpu_unblock
58	PTR_ADDU t1, t0
591:	lw	t2, 0(t1)	# wait till unblocked
60	beqz	t2, 1b
61	nop
62
63	PTR_LA	t1, nlm_next_sp
64	PTR_L	sp, 0(t1)
65	PTR_LA	t1, nlm_next_gp
66	PTR_L	gp, 0(t1)
67
68	PTR_LA	t0, nlm_early_init_secondary
69	jalr	t0
70	nop
71
72	PTR_LA	t0, smp_bootstrap
73	jr	t0
74	nop
75END(prom_pre_boot_secondary_cpus)
76
77NESTED(nlm_boot_smp_nmi, 0, sp)
78	.set push
79	.set noat
80	.set mips64
81	.set noreorder
82
83	/* Clear the  NMI and BEV bits */
84	MFC0	k0, CP0_STATUS
85	li 	k1, 0xffb7ffff
86	and	k0, k0, k1
87	MTC0	k0, CP0_STATUS
88
89	PTR_LA  k1, secondary_entry_point
90	PTR_L	k0, 0(k1)
91	jr	k0
92	nop
93	.set pop
94END(nlm_boot_smp_nmi)