128 lines
2.9 KiB
C
128 lines
2.9 KiB
C
|
/*
|
||
|
* Board setup routines for the storcenter
|
||
|
*
|
||
|
* Copyright 2007 (C) Oyvind Repvik (nail@nslu2-linux.org)
|
||
|
* Copyright 2007 Andy Wilcox, Jon Loeliger
|
||
|
*
|
||
|
* Based on linkstation.c by G. Liakhovetski
|
||
|
*
|
||
|
* This file is licensed under the terms of the GNU General Public License
|
||
|
* version 2. This program is licensed "as is" without any warranty of
|
||
|
* any kind, whether express or implied.
|
||
|
*/
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/initrd.h>
|
||
|
#include <linux/of_platform.h>
|
||
|
|
||
|
#include <asm/time.h>
|
||
|
#include <asm/mpic.h>
|
||
|
#include <asm/pci-bridge.h>
|
||
|
|
||
|
#include "mpc10x.h"
|
||
|
|
||
|
|
||
|
static const struct of_device_id storcenter_of_bus[] __initconst = {
|
||
|
{ .name = "soc", },
|
||
|
{},
|
||
|
};
|
||
|
|
||
|
static int __init storcenter_device_probe(void)
|
||
|
{
|
||
|
of_platform_bus_probe(NULL, storcenter_of_bus, NULL);
|
||
|
return 0;
|
||
|
}
|
||
|
machine_device_initcall(storcenter, storcenter_device_probe);
|
||
|
|
||
|
|
||
|
static int __init storcenter_add_bridge(struct device_node *dev)
|
||
|
{
|
||
|
#ifdef CONFIG_PCI
|
||
|
int len;
|
||
|
struct pci_controller *hose;
|
||
|
const int *bus_range;
|
||
|
|
||
|
printk("Adding PCI host bridge %pOF\n", dev);
|
||
|
|
||
|
hose = pcibios_alloc_controller(dev);
|
||
|
if (hose == NULL)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
bus_range = of_get_property(dev, "bus-range", &len);
|
||
|
hose->first_busno = bus_range ? bus_range[0] : 0;
|
||
|
hose->last_busno = bus_range ? bus_range[1] : 0xff;
|
||
|
|
||
|
setup_indirect_pci(hose, MPC10X_MAPB_CNFG_ADDR, MPC10X_MAPB_CNFG_DATA, 0);
|
||
|
|
||
|
/* Interpret the "ranges" property */
|
||
|
/* This also maps the I/O region and sets isa_io/mem_base */
|
||
|
pci_process_bridge_OF_ranges(hose, dev, 1);
|
||
|
#endif
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void __init storcenter_setup_arch(void)
|
||
|
{
|
||
|
printk(KERN_INFO "IOMEGA StorCenter\n");
|
||
|
}
|
||
|
|
||
|
static void __init storcenter_setup_pci(void)
|
||
|
{
|
||
|
struct device_node *np;
|
||
|
|
||
|
/* Lookup PCI host bridges */
|
||
|
for_each_compatible_node(np, "pci", "mpc10x-pci")
|
||
|
storcenter_add_bridge(np);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Interrupt setup and service. Interrupts on the turbostation come
|
||
|
* from the four PCI slots plus onboard 8241 devices: I2C, DUART.
|
||
|
*/
|
||
|
static void __init storcenter_init_IRQ(void)
|
||
|
{
|
||
|
struct mpic *mpic;
|
||
|
|
||
|
mpic = mpic_alloc(NULL, 0, 0, 16, 0, " OpenPIC ");
|
||
|
BUG_ON(mpic == NULL);
|
||
|
|
||
|
/*
|
||
|
* 16 Serial Interrupts followed by 16 Internal Interrupts.
|
||
|
* I2C is the second internal, so it is at 17, 0x11020.
|
||
|
*/
|
||
|
mpic_assign_isu(mpic, 0, mpic->paddr + 0x10200);
|
||
|
mpic_assign_isu(mpic, 1, mpic->paddr + 0x11000);
|
||
|
|
||
|
mpic_init(mpic);
|
||
|
}
|
||
|
|
||
|
static void __noreturn storcenter_restart(char *cmd)
|
||
|
{
|
||
|
local_irq_disable();
|
||
|
|
||
|
/* Set exception prefix high - to the firmware */
|
||
|
mtmsr(mfmsr() | MSR_IP);
|
||
|
isync();
|
||
|
|
||
|
/* Wait for reset to happen */
|
||
|
for (;;) ;
|
||
|
}
|
||
|
|
||
|
static int __init storcenter_probe(void)
|
||
|
{
|
||
|
return of_machine_is_compatible("iomega,storcenter");
|
||
|
}
|
||
|
|
||
|
define_machine(storcenter){
|
||
|
.name = "IOMEGA StorCenter",
|
||
|
.probe = storcenter_probe,
|
||
|
.setup_arch = storcenter_setup_arch,
|
||
|
.discover_phbs = storcenter_setup_pci,
|
||
|
.init_IRQ = storcenter_init_IRQ,
|
||
|
.get_irq = mpic_get_irq,
|
||
|
.restart = storcenter_restart,
|
||
|
.calibrate_decr = generic_calibrate_decr,
|
||
|
};
|