blob: 04160a4cc699a163bfabf725bcbfc3fbcd22998f [file] [log] [blame]
Kumar Galad5b26db2008-11-19 09:35:56 -06001/*
2 * Author: Andy Fleming <afleming@freescale.com>
3 * Kumar Gala <galak@kernel.crashing.org>
4 *
5 * Copyright 2006-2008 Freescale Semiconductor Inc.
6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
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>
Kumar Gala563fdd42009-02-11 22:50:42 -060024#include <asm/dbell.h>
Kumar Galad5b26db2008-11-19 09:35:56 -060025
26#include <sysdev/fsl_soc.h>
27
Kumar Galad5b26db2008-11-19 09:35:56 -060028extern 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
Kumar Galad5b26db2008-11-19 09:35:56 -060054 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);
Kumar Galad5b26db2008-11-19 09:35:56 -060059 return;
60 }
61
62 /* Map the spin table */
63 bptr_vaddr = ioremap(*cpu_rel_addr, SIZE_BOOT_ENTRY);
64
Kumar Galacb1ffb6202009-06-19 03:30:42 -050065 local_irq_save(flags);
66
Kumar Galad5b26db2008-11-19 09:35:56 -060067 out_be32(bptr_vaddr + BOOT_ENTRY_PIR, nr);
68 out_be32(bptr_vaddr + BOOT_ENTRY_ADDR_LOWER, __pa(__early_start));
69
70 /* Wait a bit for the CPU to ack. */
71 while ((__secondary_hold_acknowledge != nr) && (++n < 1000))
72 mdelay(1);
73
Kumar Galad5b26db2008-11-19 09:35:56 -060074 local_irq_restore(flags);
75
Kumar Galacb1ffb6202009-06-19 03:30:42 -050076 iounmap(bptr_vaddr);
77
Kumar Galad5b26db2008-11-19 09:35:56 -060078 pr_debug("waited %d msecs for CPU #%d.\n", n, nr);
79}
80
81static void __init
Kumar Gala563fdd42009-02-11 22:50:42 -060082smp_85xx_setup_cpu(int cpu_nr)
83{
84 mpic_setup_this_cpu();
Kumar Gala563fdd42009-02-11 22:50:42 -060085}
86
Kumar Galad5b26db2008-11-19 09:35:56 -060087struct smp_ops_t smp_85xx_ops = {
Kumar Galad5b26db2008-11-19 09:35:56 -060088 .kick_cpu = smp_85xx_kick_cpu,
Kumar Galad5b26db2008-11-19 09:35:56 -060089};
90
Kumar Gala563fdd42009-02-11 22:50:42 -060091void __init mpc85xx_smp_init(void)
92{
93 struct device_node *np;
94
Kumar Gala563fdd42009-02-11 22:50:42 -060095 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;
Kumar Gala563fdd42009-02-11 22:50:42 -0600100 }
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
Kumar Galad5b26db2008-11-19 09:35:56 -0600107 smp_ops = &smp_85xx_ops;
108}