diff options
Diffstat (limited to 'arch/powerpc/platforms/85xx/mpc85xx_ads.c')
-rw-r--r-- | arch/powerpc/platforms/85xx/mpc85xx_ads.c | 74 |
1 files changed, 6 insertions, 68 deletions
diff --git a/arch/powerpc/platforms/85xx/mpc85xx_ads.c b/arch/powerpc/platforms/85xx/mpc85xx_ads.c index 3b2c9bb66199..3bebb5173bfc 100644 --- a/arch/powerpc/platforms/85xx/mpc85xx_ads.c +++ b/arch/powerpc/platforms/85xx/mpc85xx_ads.c | |||
@@ -35,6 +35,8 @@ | |||
35 | #include <sysdev/cpm2_pic.h> | 35 | #include <sysdev/cpm2_pic.h> |
36 | #endif | 36 | #endif |
37 | 37 | ||
38 | #include "mpc85xx.h" | ||
39 | |||
38 | #ifdef CONFIG_PCI | 40 | #ifdef CONFIG_PCI |
39 | static int mpc85xx_exclude_device(struct pci_controller *hose, | 41 | static int mpc85xx_exclude_device(struct pci_controller *hose, |
40 | u_char bus, u_char devfn) | 42 | u_char bus, u_char devfn) |
@@ -46,63 +48,15 @@ static int mpc85xx_exclude_device(struct pci_controller *hose, | |||
46 | } | 48 | } |
47 | #endif /* CONFIG_PCI */ | 49 | #endif /* CONFIG_PCI */ |
48 | 50 | ||
49 | #ifdef CONFIG_CPM2 | ||
50 | |||
51 | static void cpm2_cascade(unsigned int irq, struct irq_desc *desc) | ||
52 | { | ||
53 | struct irq_chip *chip = irq_desc_get_chip(desc); | ||
54 | int cascade_irq; | ||
55 | |||
56 | while ((cascade_irq = cpm2_get_irq()) >= 0) | ||
57 | generic_handle_irq(cascade_irq); | ||
58 | |||
59 | chip->irq_eoi(&desc->irq_data); | ||
60 | } | ||
61 | |||
62 | #endif /* CONFIG_CPM2 */ | ||
63 | |||
64 | static void __init mpc85xx_ads_pic_init(void) | 51 | static void __init mpc85xx_ads_pic_init(void) |
65 | { | 52 | { |
66 | struct mpic *mpic; | 53 | struct mpic *mpic = mpic_alloc(NULL, 0, |
67 | struct resource r; | 54 | MPIC_WANTS_RESET | MPIC_BIG_ENDIAN, |
68 | struct device_node *np = NULL; | ||
69 | #ifdef CONFIG_CPM2 | ||
70 | int irq; | ||
71 | #endif | ||
72 | |||
73 | np = of_find_node_by_type(np, "open-pic"); | ||
74 | if (!np) { | ||
75 | printk(KERN_ERR "Could not find open-pic node\n"); | ||
76 | return; | ||
77 | } | ||
78 | |||
79 | if (of_address_to_resource(np, 0, &r)) { | ||
80 | printk(KERN_ERR "Could not map mpic register space\n"); | ||
81 | of_node_put(np); | ||
82 | return; | ||
83 | } | ||
84 | |||
85 | mpic = mpic_alloc(np, r.start, | ||
86 | MPIC_PRIMARY | MPIC_WANTS_RESET | MPIC_BIG_ENDIAN, | ||
87 | 0, 256, " OpenPIC "); | 55 | 0, 256, " OpenPIC "); |
88 | BUG_ON(mpic == NULL); | 56 | BUG_ON(mpic == NULL); |
89 | of_node_put(np); | ||
90 | |||
91 | mpic_init(mpic); | 57 | mpic_init(mpic); |
92 | 58 | ||
93 | #ifdef CONFIG_CPM2 | 59 | mpc85xx_cpm2_pic_init(); |
94 | /* Setup CPM2 PIC */ | ||
95 | np = of_find_compatible_node(NULL, NULL, "fsl,cpm2-pic"); | ||
96 | if (np == NULL) { | ||
97 | printk(KERN_ERR "PIC init: can not find fsl,cpm2-pic node\n"); | ||
98 | return; | ||
99 | } | ||
100 | irq = irq_of_parse_and_map(np, 0); | ||
101 | |||
102 | cpm2_pic_init(np); | ||
103 | of_node_put(np); | ||
104 | irq_set_chained_handler(irq, cpm2_cascade); | ||
105 | #endif | ||
106 | } | 60 | } |
107 | 61 | ||
108 | /* | 62 | /* |
@@ -221,23 +175,7 @@ static void mpc85xx_ads_show_cpuinfo(struct seq_file *m) | |||
221 | seq_printf(m, "PLL setting\t: 0x%x\n", ((phid1 >> 24) & 0x3f)); | 175 | seq_printf(m, "PLL setting\t: 0x%x\n", ((phid1 >> 24) & 0x3f)); |
222 | } | 176 | } |
223 | 177 | ||
224 | static struct of_device_id __initdata of_bus_ids[] = { | 178 | machine_device_initcall(mpc85xx_ads, mpc85xx_common_publish_devices); |
225 | { .name = "soc", }, | ||
226 | { .type = "soc", }, | ||
227 | { .name = "cpm", }, | ||
228 | { .name = "localbus", }, | ||
229 | { .compatible = "simple-bus", }, | ||
230 | { .compatible = "gianfar", }, | ||
231 | {}, | ||
232 | }; | ||
233 | |||
234 | static int __init declare_of_platform_devices(void) | ||
235 | { | ||
236 | of_platform_bus_probe(NULL, of_bus_ids, NULL); | ||
237 | |||
238 | return 0; | ||
239 | } | ||
240 | machine_device_initcall(mpc85xx_ads, declare_of_platform_devices); | ||
241 | 179 | ||
242 | /* | 180 | /* |
243 | * Called very early, device-tree isn't unflattened | 181 | * Called very early, device-tree isn't unflattened |