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 
84