Commit | Line | Data |
---|---|---|
5c642506 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 | ||
0c965407 | 35 | #include <linux/init.h> |
77ae798f | 36 | #include <linux/delay.h> |
0c965407 J |
37 | #include <linux/threads.h> |
38 | ||
39 | #include <asm/asm.h> | |
40 | #include <asm/asm-offsets.h> | |
41 | #include <asm/mipsregs.h> | |
42 | #include <asm/addrspace.h> | |
43 | #include <asm/string.h> | |
44 | ||
45 | #include <asm/netlogic/haldefs.h> | |
46 | #include <asm/netlogic/common.h> | |
47 | #include <asm/netlogic/mips-extns.h> | |
48 | ||
5c642506 | 49 | #include <asm/netlogic/xlr/iomap.h> |
0c965407 | 50 | #include <asm/netlogic/xlr/pic.h> |
5c642506 | 51 | |
078a55fc | 52 | int xlr_wakeup_secondary_cpus(void) |
5c642506 | 53 | { |
77ae798f J |
54 | struct nlm_soc_info *nodep; |
55 | unsigned int i, j, boot_cpu; | |
919f9abb | 56 | volatile u32 *cpu_ready = nlm_get_boot_data(BOOT_CPU_READY); |
0c965407 | 57 | |
66d29985 J |
58 | /* |
59 | * In case of RMI boot, hit with NMI to get the cores | |
60 | * from bootloader to linux code. | |
61 | */ | |
77ae798f | 62 | nodep = nlm_get_node(0); |
0c965407 | 63 | boot_cpu = hard_smp_processor_id(); |
66d29985 | 64 | nlm_set_nmi_handler(nlm_rmiboot_preboot); |
0c965407 | 65 | for (i = 0; i < NR_CPUS; i++) { |
2a37b1ae | 66 | if (i == boot_cpu || !cpumask_test_cpu(i, &nlm_cpumask)) |
0c965407 | 67 | continue; |
77ae798f J |
68 | nlm_pic_send_ipi(nodep->picbase, i, 1, 1); /* send NMI */ |
69 | } | |
70 | ||
71 | /* Fill up the coremask early */ | |
72 | nodep->coremask = 1; | |
73 | for (i = 1; i < NLM_CORES_PER_NODE; i++) { | |
74 | for (j = 1000000; j > 0; j--) { | |
919f9abb | 75 | if (cpu_ready[i * NLM_THREADS_PER_CORE]) |
77ae798f J |
76 | break; |
77 | udelay(10); | |
78 | } | |
79 | if (j != 0) | |
80 | nodep->coremask |= (1u << i); | |
81 | else | |
82 | pr_err("Failed to wakeup core %d\n", i); | |
0c965407 | 83 | } |
5c642506 | 84 | |
0c965407 | 85 | return 0; |
5c642506 | 86 | } |