arch/powerpc/platforms/512x/mpc512x_shared.c

   1 /*
   2  * Copyright (C) 2007,2008 Freescale Semiconductor, Inc. All rights reserved.
   3  *
   4  * Author: John Rigby <jrigby@freescale.com>
   5  *
   6  * Description:
   7  * MPC512x Shared code
   8  *
   9  * This is free software; you can redistribute it and/or modify it
  10  * under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  */
  14
  15 #include <linux/kernel.h>
  16 #include <linux/io.h>
  17 #include <linux/irq.h>
  18 #include <linux/of_platform.h>
  19
  20 #include <asm/machdep.h>
  21 #include <asm/ipic.h>
  22 #include <asm/prom.h>
  23 #include <asm/time.h>
  24
  25 #include "mpc512x.h"
  26
  27 unsigned long
  28 mpc512x_find_ips_freq(struct device_node *node)
  29 {
  30         struct device_node *np;
  31         const unsigned int *p_ips_freq = NULL;
  32
  33         of_node_get(node);
  34         while (node) {
  35                 p_ips_freq = of_get_property(node, "bus-frequency", NULL);
  36                 if (p_ips_freq)
  37                         break;
  38
  39                 np = of_get_parent(node);
  40                 of_node_put(node);
  41                 node = np;
  42         }
  43         if (node)
  44                 of_node_put(node);
  45
  46         return p_ips_freq ? *p_ips_freq : 0;
  47 }
  48 EXPORT_SYMBOL(mpc512x_find_ips_freq);
  49
  50 void __init mpc512x_init_IRQ(void)
  51 {
  52         struct device_node *np;
  53
  54         np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121-ipic");
  55         if (!np)
  56                 return;
  57
  58         ipic_init(np, 0);
  59         of_node_put(np);
  60
  61         /*
  62          * Initialize the default interrupt mapping priorities,
  63          * in case the boot rom changed something on us.
  64          */
  65         ipic_set_default_priority();
  66 }
  67
  68 /*
  69  * Nodes to do bus probe on, soc and localbus
  70  */
  71 static struct of_device_id __initdata of_bus_ids[] = {
  72         { .compatible = "fsl,mpc5121-immr", },
  73         { .compatible = "fsl,mpc5121-localbus", },
  74         {},
  75 };
  76
  77 void __init mpc512x_declare_of_platform_devices(void)
  78 {
  79         if (of_platform_bus_probe(NULL, of_bus_ids, NULL))
  80                 printk(KERN_ERR __FILE__ ": "
  81                         "Error while probing of_platform bus\n");
  82 }
  83