| /* |
| * SBC8641D board specific routines |
| * |
| * Copyright 2008 Wind River Systems Inc. |
| * |
| * By Paul Gortmaker (see MAINTAINERS for contact information) |
| * |
| * Based largely on the 8641 HPCN support by Freescale Semiconductor Inc. |
| * |
| * This program 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/stddef.h> |
| #include <linux/kernel.h> |
| #include <linux/pci.h> |
| #include <linux/kdev_t.h> |
| #include <linux/delay.h> |
| #include <linux/seq_file.h> |
| #include <linux/of_platform.h> |
| |
| #include <asm/system.h> |
| #include <asm/time.h> |
| #include <asm/machdep.h> |
| #include <asm/pci-bridge.h> |
| #include <asm/mpc86xx.h> |
| #include <asm/prom.h> |
| #include <mm/mmu_decl.h> |
| #include <asm/udbg.h> |
| |
| #include <asm/mpic.h> |
| |
| #include <sysdev/fsl_pci.h> |
| #include <sysdev/fsl_soc.h> |
| |
| #include "mpc86xx.h" |
| |
| static void __init |
| sbc8641_init_irq(void) |
| { |
| struct mpic *mpic1; |
| struct device_node *np; |
| struct resource res; |
| |
| /* Determine PIC address. */ |
| np = of_find_node_by_type(NULL, "open-pic"); |
| if (np == NULL) |
| return; |
| of_address_to_resource(np, 0, &res); |
| |
| /* Alloc mpic structure and per isu has 16 INT entries. */ |
| mpic1 = mpic_alloc(np, res.start, |
| MPIC_PRIMARY | MPIC_WANTS_RESET | MPIC_BIG_ENDIAN, |
| 0, 256, " MPIC "); |
| of_node_put(np); |
| BUG_ON(mpic1 == NULL); |
| |
| mpic_init(mpic1); |
| } |
| |
| static void __init |
| sbc8641_setup_arch(void) |
| { |
| #ifdef CONFIG_PCI |
| struct device_node *np; |
| #endif |
| |
| if (ppc_md.progress) |
| ppc_md.progress("sbc8641_setup_arch()", 0); |
| |
| #ifdef CONFIG_PCI |
| for_each_compatible_node(np, "pci", "fsl,mpc8641-pcie") |
| fsl_add_bridge(np, 0); |
| #endif |
| |
| printk("SBC8641 board from Wind River\n"); |
| |
| #ifdef CONFIG_SMP |
| mpc86xx_smp_init(); |
| #endif |
| } |
| |
| |
| static void |
| sbc8641_show_cpuinfo(struct seq_file *m) |
| { |
| struct device_node *root; |
| uint memsize = total_memory; |
| const char *model = ""; |
| uint svid = mfspr(SPRN_SVR); |
| |
| seq_printf(m, "Vendor\t\t: Wind River Systems\n"); |
| |
| root = of_find_node_by_path("/"); |
| if (root) |
| model = of_get_property(root, "model", NULL); |
| seq_printf(m, "Machine\t\t: %s\n", model); |
| of_node_put(root); |
| |
| seq_printf(m, "SVR\t\t: 0x%x\n", svid); |
| seq_printf(m, "Memory\t\t: %d MB\n", memsize / (1024 * 1024)); |
| } |
| |
| |
| /* |
| * Called very early, device-tree isn't unflattened |
| */ |
| static int __init sbc8641_probe(void) |
| { |
| unsigned long root = of_get_flat_dt_root(); |
| |
| if (of_flat_dt_is_compatible(root, "wind,sbc8641")) |
| return 1; /* Looks good */ |
| |
| return 0; |
| } |
| |
| static long __init |
| mpc86xx_time_init(void) |
| { |
| unsigned int temp; |
| |
| /* Set the time base to zero */ |
| mtspr(SPRN_TBWL, 0); |
| mtspr(SPRN_TBWU, 0); |
| |
| temp = mfspr(SPRN_HID0); |
| temp |= HID0_TBEN; |
| mtspr(SPRN_HID0, temp); |
| asm volatile("isync"); |
| |
| return 0; |
| } |
| |
| static __initdata struct of_device_id of_bus_ids[] = { |
| { .compatible = "simple-bus", }, |
| {}, |
| }; |
| |
| static int __init declare_of_platform_devices(void) |
| { |
| of_platform_bus_probe(NULL, of_bus_ids, NULL); |
| |
| return 0; |
| } |
| machine_device_initcall(sbc8641, declare_of_platform_devices); |
| |
| define_machine(sbc8641) { |
| .name = "SBC8641D", |
| .probe = sbc8641_probe, |
| .setup_arch = sbc8641_setup_arch, |
| .init_IRQ = sbc8641_init_irq, |
| .show_cpuinfo = sbc8641_show_cpuinfo, |
| .get_irq = mpic_get_irq, |
| .restart = fsl_rstcr_restart, |
| .time_init = mpc86xx_time_init, |
| .calibrate_decr = generic_calibrate_decr, |
| .progress = udbg_progress, |
| #ifdef CONFIG_PCI |
| .pcibios_fixup_bus = fsl_pcibios_fixup_bus, |
| #endif |
| }; |