Commit | Line | Data |
---|---|---|
543a07b1 DES |
1 | /* |
2 | * Routines common to most mpc85xx-based boards. | |
3 | * | |
4 | * This is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License version 2 as | |
6 | * published by the Free Software Foundation. | |
7 | */ | |
8 | #include <linux/of_platform.h> | |
9 | ||
10 | #include <sysdev/cpm2_pic.h> | |
11 | ||
12 | #include "mpc85xx.h" | |
13 | ||
46d026ac DES |
14 | static struct of_device_id __initdata mpc85xx_common_ids[] = { |
15 | { .type = "soc", }, | |
16 | { .compatible = "soc", }, | |
17 | { .compatible = "simple-bus", }, | |
18 | { .name = "cpm", }, | |
19 | { .name = "localbus", }, | |
20 | { .compatible = "gianfar", }, | |
21 | { .compatible = "fsl,qe", }, | |
22 | { .compatible = "fsl,cpm2", }, | |
23 | {}, | |
24 | }; | |
25 | ||
26 | int __init mpc85xx_common_publish_devices(void) | |
27 | { | |
28 | return of_platform_bus_probe(NULL, mpc85xx_common_ids, NULL); | |
29 | } | |
543a07b1 DES |
30 | #ifdef CONFIG_CPM2 |
31 | static void cpm2_cascade(unsigned int irq, struct irq_desc *desc) | |
32 | { | |
33 | struct irq_chip *chip = irq_desc_get_chip(desc); | |
34 | int cascade_irq; | |
35 | ||
36 | while ((cascade_irq = cpm2_get_irq()) >= 0) | |
37 | generic_handle_irq(cascade_irq); | |
38 | ||
39 | chip->irq_eoi(&desc->irq_data); | |
40 | } | |
41 | ||
42 | ||
43 | void __init mpc85xx_cpm2_pic_init(void) | |
44 | { | |
45 | struct device_node *np; | |
46 | int irq; | |
47 | ||
48 | /* Setup CPM2 PIC */ | |
49 | np = of_find_compatible_node(NULL, NULL, "fsl,cpm2-pic"); | |
50 | if (np == NULL) { | |
51 | printk(KERN_ERR "PIC init: can not find fsl,cpm2-pic node\n"); | |
52 | return; | |
53 | } | |
54 | irq = irq_of_parse_and_map(np, 0); | |
55 | if (irq == NO_IRQ) { | |
56 | of_node_put(np); | |
57 | printk(KERN_ERR "PIC init: got no IRQ for cpm cascade\n"); | |
58 | return; | |
59 | } | |
60 | ||
61 | cpm2_pic_init(np); | |
62 | of_node_put(np); | |
63 | irq_set_chained_handler(irq, cpm2_cascade); | |
64 | } | |
65 | #endif |