arch/powerpc/platforms/85xx/mpc85xx_common.c

   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
  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         { .compatible = "fsl,srio", },
  24         {},
  25 };
  26
  27 int __init mpc85xx_common_publish_devices(void)
  28 {
  29         return of_platform_bus_probe(NULL, mpc85xx_common_ids, NULL);
  30 }
  31 #ifdef CONFIG_CPM2
  32 static void cpm2_cascade(unsigned int irq, struct irq_desc *desc)
  33 {
  34         struct irq_chip *chip = irq_desc_get_chip(desc);
  35         int cascade_irq;
  36
  37         while ((cascade_irq = cpm2_get_irq()) >= 0)
  38                 generic_handle_irq(cascade_irq);
  39
  40         chip->irq_eoi(&desc->irq_data);
  41 }
  42
  43
  44 void __init mpc85xx_cpm2_pic_init(void)
  45 {
  46         struct device_node *np;
  47         int irq;
  48
  49         /* Setup CPM2 PIC */
  50         np = of_find_compatible_node(NULL, NULL, "fsl,cpm2-pic");
  51         if (np == NULL) {
  52                 printk(KERN_ERR "PIC init: can not find fsl,cpm2-pic node\n");
  53                 return;
  54         }
  55         irq = irq_of_parse_and_map(np, 0);
  56         if (irq == NO_IRQ) {
  57                 of_node_put(np);
  58                 printk(KERN_ERR "PIC init: got no IRQ for cpm cascade\n");
  59                 return;
  60         }
  61
  62         cpm2_pic_init(np);
  63         of_node_put(np);
  64         irq_set_chained_handler(irq, cpm2_cascade);
  65 }
  66 #endif