| /* |
| * Copyright (C) 2007,2008 Freescale Semiconductor, Inc. All rights reserved. |
| * |
| * Author: John Rigby <jrigby@freescale.com> |
| * |
| * Description: |
| * MPC512x Shared code |
| * |
| * This is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/io.h> |
| #include <linux/irq.h> |
| #include <linux/of_platform.h> |
| |
| #include <asm/machdep.h> |
| #include <asm/ipic.h> |
| #include <asm/prom.h> |
| #include <asm/time.h> |
| |
| #include "mpc512x.h" |
| |
| unsigned long |
| mpc512x_find_ips_freq(struct device_node *node) |
| { |
| struct device_node *np; |
| const unsigned int *p_ips_freq = NULL; |
| |
| of_node_get(node); |
| while (node) { |
| p_ips_freq = of_get_property(node, "bus-frequency", NULL); |
| if (p_ips_freq) |
| break; |
| |
| np = of_get_parent(node); |
| of_node_put(node); |
| node = np; |
| } |
| if (node) |
| of_node_put(node); |
| |
| return p_ips_freq ? *p_ips_freq : 0; |
| } |
| EXPORT_SYMBOL(mpc512x_find_ips_freq); |
| |
| void __init mpc512x_init_IRQ(void) |
| { |
| struct device_node *np; |
| |
| np = of_find_compatible_node(NULL, NULL, "fsl,mpc5121-ipic"); |
| if (!np) |
| return; |
| |
| ipic_init(np, 0); |
| of_node_put(np); |
| |
| /* |
| * Initialize the default interrupt mapping priorities, |
| * in case the boot rom changed something on us. |
| */ |
| ipic_set_default_priority(); |
| } |
| |
| /* |
| * Nodes to do bus probe on, soc and localbus |
| */ |
| static struct of_device_id __initdata of_bus_ids[] = { |
| { .compatible = "fsl,mpc5121-immr", }, |
| { .compatible = "fsl,mpc5121-localbus", }, |
| {}, |
| }; |
| |
| void __init mpc512x_declare_of_platform_devices(void) |
| { |
| if (of_platform_bus_probe(NULL, of_bus_ids, NULL)) |
| printk(KERN_ERR __FILE__ ": " |
| "Error while probing of_platform bus\n"); |
| } |
| |