1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/stddef.h>
14#include <linux/kernel.h>
15#include <linux/init.h>
16#include <linux/delay.h>
17#include <linux/of.h>
18
19#include <asm/machdep.h>
20#include <asm/pgtable.h>
21#include <asm/page.h>
22#include <asm/mpic.h>
23#include <asm/cacheflush.h>
24#include <asm/dbell.h>
25
26#include <sysdev/fsl_soc.h>
27
28extern void __early_start(void);
29
30#define BOOT_ENTRY_ADDR_UPPER 0
31#define BOOT_ENTRY_ADDR_LOWER 1
32#define BOOT_ENTRY_R3_UPPER 2
33#define BOOT_ENTRY_R3_LOWER 3
34#define BOOT_ENTRY_RESV 4
35#define BOOT_ENTRY_PIR 5
36#define BOOT_ENTRY_R6_UPPER 6
37#define BOOT_ENTRY_R6_LOWER 7
38#define NUM_BOOT_ENTRY 8
39#define SIZE_BOOT_ENTRY (NUM_BOOT_ENTRY * sizeof(u32))
40
41static void __init
42smp_85xx_kick_cpu(int nr)
43{
44 unsigned long flags;
45 const u64 *cpu_rel_addr;
46 __iomem u32 *bptr_vaddr;
47 struct device_node *np;
48 int n = 0;
49
50 WARN_ON (nr < 0 || nr >= NR_CPUS);
51
52 pr_debug("smp_85xx_kick_cpu: kick CPU #%d\n", nr);
53
54 np = of_get_cpu_node(nr, NULL);
55 cpu_rel_addr = of_get_property(np, "cpu-release-addr", NULL);
56
57 if (cpu_rel_addr == NULL) {
58 printk(KERN_ERR "No cpu-release-addr for cpu %d\n", nr);
59 return;
60 }
61
62
63 bptr_vaddr = ioremap(*cpu_rel_addr, SIZE_BOOT_ENTRY);
64
65 local_irq_save(flags);
66
67 out_be32(bptr_vaddr + BOOT_ENTRY_PIR, nr);
68 out_be32(bptr_vaddr + BOOT_ENTRY_ADDR_LOWER, __pa(__early_start));
69
70
71 while ((__secondary_hold_acknowledge != nr) && (++n < 1000))
72 mdelay(1);
73
74 local_irq_restore(flags);
75
76 iounmap(bptr_vaddr);
77
78 pr_debug("waited %d msecs for CPU #%d.\n", n, nr);
79}
80
81static void __init
82smp_85xx_setup_cpu(int cpu_nr)
83{
84 mpic_setup_this_cpu();
85}
86
87struct smp_ops_t smp_85xx_ops = {
88 .kick_cpu = smp_85xx_kick_cpu,
89};
90
91void __init mpc85xx_smp_init(void)
92{
93 struct device_node *np;
94
95 np = of_find_node_by_type(NULL, "open-pic");
96 if (np) {
97 smp_85xx_ops.probe = smp_mpic_probe;
98 smp_85xx_ops.setup_cpu = smp_85xx_setup_cpu;
99 smp_85xx_ops.message_pass = smp_mpic_message_pass;
100 }
101
102 if (cpu_has_feature(CPU_FTR_DBELL))
103 smp_85xx_ops.message_pass = smp_dbell_message_pass;
104
105 BUG_ON(!smp_85xx_ops.message_pass);
106
107 smp_ops = &smp_85xx_ops;
108}
109