18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * MPC85xx setup and early boot code plus other random bits. 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Maintained by Kumar Gala (see MAINTAINERS for contact information) 68c2ecf20Sopenharmony_ci * 78c2ecf20Sopenharmony_ci * Copyright 2005, 2011-2012 Freescale Semiconductor Inc. 88c2ecf20Sopenharmony_ci */ 98c2ecf20Sopenharmony_ci 108c2ecf20Sopenharmony_ci#include <linux/stddef.h> 118c2ecf20Sopenharmony_ci#include <linux/kernel.h> 128c2ecf20Sopenharmony_ci#include <linux/init.h> 138c2ecf20Sopenharmony_ci#include <linux/errno.h> 148c2ecf20Sopenharmony_ci#include <linux/reboot.h> 158c2ecf20Sopenharmony_ci#include <linux/pci.h> 168c2ecf20Sopenharmony_ci#include <linux/kdev_t.h> 178c2ecf20Sopenharmony_ci#include <linux/major.h> 188c2ecf20Sopenharmony_ci#include <linux/console.h> 198c2ecf20Sopenharmony_ci#include <linux/delay.h> 208c2ecf20Sopenharmony_ci#include <linux/seq_file.h> 218c2ecf20Sopenharmony_ci#include <linux/initrd.h> 228c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 238c2ecf20Sopenharmony_ci#include <linux/fsl_devices.h> 248c2ecf20Sopenharmony_ci#include <linux/of_platform.h> 258c2ecf20Sopenharmony_ci#include <linux/pgtable.h> 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci#include <asm/page.h> 288c2ecf20Sopenharmony_ci#include <linux/atomic.h> 298c2ecf20Sopenharmony_ci#include <asm/time.h> 308c2ecf20Sopenharmony_ci#include <asm/io.h> 318c2ecf20Sopenharmony_ci#include <asm/machdep.h> 328c2ecf20Sopenharmony_ci#include <asm/ipic.h> 338c2ecf20Sopenharmony_ci#include <asm/pci-bridge.h> 348c2ecf20Sopenharmony_ci#include <asm/irq.h> 358c2ecf20Sopenharmony_ci#include <mm/mmu_decl.h> 368c2ecf20Sopenharmony_ci#include <asm/prom.h> 378c2ecf20Sopenharmony_ci#include <asm/udbg.h> 388c2ecf20Sopenharmony_ci#include <asm/mpic.h> 398c2ecf20Sopenharmony_ci#include <asm/i8259.h> 408c2ecf20Sopenharmony_ci 418c2ecf20Sopenharmony_ci#include <sysdev/fsl_soc.h> 428c2ecf20Sopenharmony_ci#include <sysdev/fsl_pci.h> 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ci#include "mpc85xx.h" 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci/* 478c2ecf20Sopenharmony_ci * The CDS board contains an FPGA/CPLD called "Cadmus", which collects 488c2ecf20Sopenharmony_ci * various logic and performs system control functions. 498c2ecf20Sopenharmony_ci * Here is the FPGA/CPLD register map. 508c2ecf20Sopenharmony_ci */ 518c2ecf20Sopenharmony_cistruct cadmus_reg { 528c2ecf20Sopenharmony_ci u8 cm_ver; /* Board version */ 538c2ecf20Sopenharmony_ci u8 cm_csr; /* General control/status */ 548c2ecf20Sopenharmony_ci u8 cm_rst; /* Reset control */ 558c2ecf20Sopenharmony_ci u8 cm_hsclk; /* High speed clock */ 568c2ecf20Sopenharmony_ci u8 cm_hsxclk; /* High speed clock extended */ 578c2ecf20Sopenharmony_ci u8 cm_led; /* LED data */ 588c2ecf20Sopenharmony_ci u8 cm_pci; /* PCI control/status */ 598c2ecf20Sopenharmony_ci u8 cm_dma; /* DMA control */ 608c2ecf20Sopenharmony_ci u8 res[248]; /* Total 256 bytes */ 618c2ecf20Sopenharmony_ci}; 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_cistatic struct cadmus_reg *cadmus; 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_ci#ifdef CONFIG_PCI 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_ci#define ARCADIA_HOST_BRIDGE_IDSEL 17 688c2ecf20Sopenharmony_ci#define ARCADIA_2ND_BRIDGE_IDSEL 3 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_cistatic int mpc85xx_exclude_device(struct pci_controller *hose, 718c2ecf20Sopenharmony_ci u_char bus, u_char devfn) 728c2ecf20Sopenharmony_ci{ 738c2ecf20Sopenharmony_ci /* We explicitly do not go past the Tundra 320 Bridge */ 748c2ecf20Sopenharmony_ci if ((bus == 1) && (PCI_SLOT(devfn) == ARCADIA_2ND_BRIDGE_IDSEL)) 758c2ecf20Sopenharmony_ci return PCIBIOS_DEVICE_NOT_FOUND; 768c2ecf20Sopenharmony_ci if ((bus == 0) && (PCI_SLOT(devfn) == ARCADIA_2ND_BRIDGE_IDSEL)) 778c2ecf20Sopenharmony_ci return PCIBIOS_DEVICE_NOT_FOUND; 788c2ecf20Sopenharmony_ci else 798c2ecf20Sopenharmony_ci return PCIBIOS_SUCCESSFUL; 808c2ecf20Sopenharmony_ci} 818c2ecf20Sopenharmony_ci 828c2ecf20Sopenharmony_cistatic int mpc85xx_cds_restart(struct notifier_block *this, 838c2ecf20Sopenharmony_ci unsigned long mode, void *cmd) 848c2ecf20Sopenharmony_ci{ 858c2ecf20Sopenharmony_ci struct pci_dev *dev; 868c2ecf20Sopenharmony_ci u_char tmp; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci if ((dev = pci_get_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686, 898c2ecf20Sopenharmony_ci NULL))) { 908c2ecf20Sopenharmony_ci 918c2ecf20Sopenharmony_ci /* Use the VIA Super Southbridge to force a PCI reset */ 928c2ecf20Sopenharmony_ci pci_read_config_byte(dev, 0x47, &tmp); 938c2ecf20Sopenharmony_ci pci_write_config_byte(dev, 0x47, tmp | 1); 948c2ecf20Sopenharmony_ci 958c2ecf20Sopenharmony_ci /* Flush the outbound PCI write queues */ 968c2ecf20Sopenharmony_ci pci_read_config_byte(dev, 0x47, &tmp); 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_ci /* 998c2ecf20Sopenharmony_ci * At this point, the hardware reset should have triggered. 1008c2ecf20Sopenharmony_ci * However, if it doesn't work for some mysterious reason, 1018c2ecf20Sopenharmony_ci * just fall through to the default reset below. 1028c2ecf20Sopenharmony_ci */ 1038c2ecf20Sopenharmony_ci 1048c2ecf20Sopenharmony_ci pci_dev_put(dev); 1058c2ecf20Sopenharmony_ci } 1068c2ecf20Sopenharmony_ci 1078c2ecf20Sopenharmony_ci /* 1088c2ecf20Sopenharmony_ci * If we can't find the VIA chip (maybe the P2P bridge is 1098c2ecf20Sopenharmony_ci * disabled) or the VIA chip reset didn't work, just return 1108c2ecf20Sopenharmony_ci * and let default reset sequence happen. 1118c2ecf20Sopenharmony_ci */ 1128c2ecf20Sopenharmony_ci return NOTIFY_DONE; 1138c2ecf20Sopenharmony_ci} 1148c2ecf20Sopenharmony_ci 1158c2ecf20Sopenharmony_cistatic int mpc85xx_cds_restart_register(void) 1168c2ecf20Sopenharmony_ci{ 1178c2ecf20Sopenharmony_ci static struct notifier_block restart_handler; 1188c2ecf20Sopenharmony_ci 1198c2ecf20Sopenharmony_ci restart_handler.notifier_call = mpc85xx_cds_restart; 1208c2ecf20Sopenharmony_ci restart_handler.priority = 192; 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_ci return register_restart_handler(&restart_handler); 1238c2ecf20Sopenharmony_ci} 1248c2ecf20Sopenharmony_cimachine_arch_initcall(mpc85xx_cds, mpc85xx_cds_restart_register); 1258c2ecf20Sopenharmony_ci 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_cistatic void __init mpc85xx_cds_pci_irq_fixup(struct pci_dev *dev) 1288c2ecf20Sopenharmony_ci{ 1298c2ecf20Sopenharmony_ci u_char c; 1308c2ecf20Sopenharmony_ci if (dev->vendor == PCI_VENDOR_ID_VIA) { 1318c2ecf20Sopenharmony_ci switch (dev->device) { 1328c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_VIA_82C586_1: 1338c2ecf20Sopenharmony_ci /* 1348c2ecf20Sopenharmony_ci * U-Boot does not set the enable bits 1358c2ecf20Sopenharmony_ci * for the IDE device. Force them on here. 1368c2ecf20Sopenharmony_ci */ 1378c2ecf20Sopenharmony_ci pci_read_config_byte(dev, 0x40, &c); 1388c2ecf20Sopenharmony_ci c |= 0x03; /* IDE: Chip Enable Bits */ 1398c2ecf20Sopenharmony_ci pci_write_config_byte(dev, 0x40, c); 1408c2ecf20Sopenharmony_ci 1418c2ecf20Sopenharmony_ci /* 1428c2ecf20Sopenharmony_ci * Since only primary interface works, force the 1438c2ecf20Sopenharmony_ci * IDE function to standard primary IDE interrupt 1448c2ecf20Sopenharmony_ci * w/ 8259 offset 1458c2ecf20Sopenharmony_ci */ 1468c2ecf20Sopenharmony_ci dev->irq = 14; 1478c2ecf20Sopenharmony_ci pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq); 1488c2ecf20Sopenharmony_ci break; 1498c2ecf20Sopenharmony_ci /* 1508c2ecf20Sopenharmony_ci * Force legacy USB interrupt routing 1518c2ecf20Sopenharmony_ci */ 1528c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_VIA_82C586_2: 1538c2ecf20Sopenharmony_ci /* There are two USB controllers. 1548c2ecf20Sopenharmony_ci * Identify them by functon number 1558c2ecf20Sopenharmony_ci */ 1568c2ecf20Sopenharmony_ci if (PCI_FUNC(dev->devfn) == 3) 1578c2ecf20Sopenharmony_ci dev->irq = 11; 1588c2ecf20Sopenharmony_ci else 1598c2ecf20Sopenharmony_ci dev->irq = 10; 1608c2ecf20Sopenharmony_ci pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq); 1618c2ecf20Sopenharmony_ci default: 1628c2ecf20Sopenharmony_ci break; 1638c2ecf20Sopenharmony_ci } 1648c2ecf20Sopenharmony_ci } 1658c2ecf20Sopenharmony_ci} 1668c2ecf20Sopenharmony_ci 1678c2ecf20Sopenharmony_cistatic void skip_fake_bridge(struct pci_dev *dev) 1688c2ecf20Sopenharmony_ci{ 1698c2ecf20Sopenharmony_ci /* Make it an error to skip the fake bridge 1708c2ecf20Sopenharmony_ci * in pci_setup_device() in probe.c */ 1718c2ecf20Sopenharmony_ci dev->hdr_type = 0x7f; 1728c2ecf20Sopenharmony_ci} 1738c2ecf20Sopenharmony_ciDECLARE_PCI_FIXUP_EARLY(0x1957, 0x3fff, skip_fake_bridge); 1748c2ecf20Sopenharmony_ciDECLARE_PCI_FIXUP_EARLY(0x3fff, 0x1957, skip_fake_bridge); 1758c2ecf20Sopenharmony_ciDECLARE_PCI_FIXUP_EARLY(0xff3f, 0x5719, skip_fake_bridge); 1768c2ecf20Sopenharmony_ci 1778c2ecf20Sopenharmony_ci#define PCI_DEVICE_ID_IDT_TSI310 0x01a7 1788c2ecf20Sopenharmony_ci 1798c2ecf20Sopenharmony_ci/* 1808c2ecf20Sopenharmony_ci * Fix Tsi310 PCI-X bridge resource. 1818c2ecf20Sopenharmony_ci * Force the bridge to open a window from 0x0000-0x1fff in PCI I/O space. 1828c2ecf20Sopenharmony_ci * This allows legacy I/O(i8259, etc) on the VIA southbridge to be accessed. 1838c2ecf20Sopenharmony_ci */ 1848c2ecf20Sopenharmony_civoid mpc85xx_cds_fixup_bus(struct pci_bus *bus) 1858c2ecf20Sopenharmony_ci{ 1868c2ecf20Sopenharmony_ci struct pci_dev *dev = bus->self; 1878c2ecf20Sopenharmony_ci struct resource *res = bus->resource[0]; 1888c2ecf20Sopenharmony_ci 1898c2ecf20Sopenharmony_ci if (dev != NULL && 1908c2ecf20Sopenharmony_ci dev->vendor == PCI_VENDOR_ID_IBM && 1918c2ecf20Sopenharmony_ci dev->device == PCI_DEVICE_ID_IDT_TSI310) { 1928c2ecf20Sopenharmony_ci if (res) { 1938c2ecf20Sopenharmony_ci res->start = 0; 1948c2ecf20Sopenharmony_ci res->end = 0x1fff; 1958c2ecf20Sopenharmony_ci res->flags = IORESOURCE_IO; 1968c2ecf20Sopenharmony_ci pr_info("mpc85xx_cds: PCI bridge resource fixup applied\n"); 1978c2ecf20Sopenharmony_ci pr_info("mpc85xx_cds: %pR\n", res); 1988c2ecf20Sopenharmony_ci } 1998c2ecf20Sopenharmony_ci } 2008c2ecf20Sopenharmony_ci 2018c2ecf20Sopenharmony_ci fsl_pcibios_fixup_bus(bus); 2028c2ecf20Sopenharmony_ci} 2038c2ecf20Sopenharmony_ci 2048c2ecf20Sopenharmony_ci#ifdef CONFIG_PPC_I8259 2058c2ecf20Sopenharmony_cistatic void mpc85xx_8259_cascade_handler(struct irq_desc *desc) 2068c2ecf20Sopenharmony_ci{ 2078c2ecf20Sopenharmony_ci unsigned int cascade_irq = i8259_irq(); 2088c2ecf20Sopenharmony_ci 2098c2ecf20Sopenharmony_ci if (cascade_irq) 2108c2ecf20Sopenharmony_ci /* handle an interrupt from the 8259 */ 2118c2ecf20Sopenharmony_ci generic_handle_irq(cascade_irq); 2128c2ecf20Sopenharmony_ci 2138c2ecf20Sopenharmony_ci /* check for any interrupts from the shared IRQ line */ 2148c2ecf20Sopenharmony_ci handle_fasteoi_irq(desc); 2158c2ecf20Sopenharmony_ci} 2168c2ecf20Sopenharmony_ci 2178c2ecf20Sopenharmony_cistatic irqreturn_t mpc85xx_8259_cascade_action(int irq, void *dev_id) 2188c2ecf20Sopenharmony_ci{ 2198c2ecf20Sopenharmony_ci return IRQ_HANDLED; 2208c2ecf20Sopenharmony_ci} 2218c2ecf20Sopenharmony_ci#endif /* PPC_I8259 */ 2228c2ecf20Sopenharmony_ci#endif /* CONFIG_PCI */ 2238c2ecf20Sopenharmony_ci 2248c2ecf20Sopenharmony_cistatic void __init mpc85xx_cds_pic_init(void) 2258c2ecf20Sopenharmony_ci{ 2268c2ecf20Sopenharmony_ci struct mpic *mpic; 2278c2ecf20Sopenharmony_ci mpic = mpic_alloc(NULL, 0, MPIC_BIG_ENDIAN, 2288c2ecf20Sopenharmony_ci 0, 256, " OpenPIC "); 2298c2ecf20Sopenharmony_ci BUG_ON(mpic == NULL); 2308c2ecf20Sopenharmony_ci mpic_init(mpic); 2318c2ecf20Sopenharmony_ci} 2328c2ecf20Sopenharmony_ci 2338c2ecf20Sopenharmony_ci#if defined(CONFIG_PPC_I8259) && defined(CONFIG_PCI) 2348c2ecf20Sopenharmony_cistatic int mpc85xx_cds_8259_attach(void) 2358c2ecf20Sopenharmony_ci{ 2368c2ecf20Sopenharmony_ci int ret; 2378c2ecf20Sopenharmony_ci struct device_node *np = NULL; 2388c2ecf20Sopenharmony_ci struct device_node *cascade_node = NULL; 2398c2ecf20Sopenharmony_ci int cascade_irq; 2408c2ecf20Sopenharmony_ci 2418c2ecf20Sopenharmony_ci /* Initialize the i8259 controller */ 2428c2ecf20Sopenharmony_ci for_each_node_by_type(np, "interrupt-controller") 2438c2ecf20Sopenharmony_ci if (of_device_is_compatible(np, "chrp,iic")) { 2448c2ecf20Sopenharmony_ci cascade_node = np; 2458c2ecf20Sopenharmony_ci break; 2468c2ecf20Sopenharmony_ci } 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_ci if (cascade_node == NULL) { 2498c2ecf20Sopenharmony_ci printk(KERN_DEBUG "Could not find i8259 PIC\n"); 2508c2ecf20Sopenharmony_ci return -ENODEV; 2518c2ecf20Sopenharmony_ci } 2528c2ecf20Sopenharmony_ci 2538c2ecf20Sopenharmony_ci cascade_irq = irq_of_parse_and_map(cascade_node, 0); 2548c2ecf20Sopenharmony_ci if (!cascade_irq) { 2558c2ecf20Sopenharmony_ci printk(KERN_ERR "Failed to map cascade interrupt\n"); 2568c2ecf20Sopenharmony_ci return -ENXIO; 2578c2ecf20Sopenharmony_ci } 2588c2ecf20Sopenharmony_ci 2598c2ecf20Sopenharmony_ci i8259_init(cascade_node, 0); 2608c2ecf20Sopenharmony_ci of_node_put(cascade_node); 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_ci /* 2638c2ecf20Sopenharmony_ci * Hook the interrupt to make sure desc->action is never NULL. 2648c2ecf20Sopenharmony_ci * This is required to ensure that the interrupt does not get 2658c2ecf20Sopenharmony_ci * disabled when the last user of the shared IRQ line frees their 2668c2ecf20Sopenharmony_ci * interrupt. 2678c2ecf20Sopenharmony_ci */ 2688c2ecf20Sopenharmony_ci ret = request_irq(cascade_irq, mpc85xx_8259_cascade_action, 2698c2ecf20Sopenharmony_ci IRQF_SHARED | IRQF_NO_THREAD, "8259 cascade", 2708c2ecf20Sopenharmony_ci cascade_node); 2718c2ecf20Sopenharmony_ci if (ret) { 2728c2ecf20Sopenharmony_ci printk(KERN_ERR "Failed to setup cascade interrupt\n"); 2738c2ecf20Sopenharmony_ci return ret; 2748c2ecf20Sopenharmony_ci } 2758c2ecf20Sopenharmony_ci 2768c2ecf20Sopenharmony_ci /* Success. Connect our low-level cascade handler. */ 2778c2ecf20Sopenharmony_ci irq_set_handler(cascade_irq, mpc85xx_8259_cascade_handler); 2788c2ecf20Sopenharmony_ci 2798c2ecf20Sopenharmony_ci return 0; 2808c2ecf20Sopenharmony_ci} 2818c2ecf20Sopenharmony_cimachine_device_initcall(mpc85xx_cds, mpc85xx_cds_8259_attach); 2828c2ecf20Sopenharmony_ci 2838c2ecf20Sopenharmony_ci#endif /* CONFIG_PPC_I8259 */ 2848c2ecf20Sopenharmony_ci 2858c2ecf20Sopenharmony_cistatic void mpc85xx_cds_pci_assign_primary(void) 2868c2ecf20Sopenharmony_ci{ 2878c2ecf20Sopenharmony_ci#ifdef CONFIG_PCI 2888c2ecf20Sopenharmony_ci struct device_node *np; 2898c2ecf20Sopenharmony_ci 2908c2ecf20Sopenharmony_ci if (fsl_pci_primary) 2918c2ecf20Sopenharmony_ci return; 2928c2ecf20Sopenharmony_ci 2938c2ecf20Sopenharmony_ci /* 2948c2ecf20Sopenharmony_ci * MPC85xx_CDS has ISA bridge but unfortunately there is no 2958c2ecf20Sopenharmony_ci * isa node in device tree. We now looking for i8259 node as 2968c2ecf20Sopenharmony_ci * a workaround for such a broken device tree. This routine 2978c2ecf20Sopenharmony_ci * is for complying to all device trees. 2988c2ecf20Sopenharmony_ci */ 2998c2ecf20Sopenharmony_ci np = of_find_node_by_name(NULL, "i8259"); 3008c2ecf20Sopenharmony_ci while ((fsl_pci_primary = of_get_parent(np))) { 3018c2ecf20Sopenharmony_ci of_node_put(np); 3028c2ecf20Sopenharmony_ci np = fsl_pci_primary; 3038c2ecf20Sopenharmony_ci 3048c2ecf20Sopenharmony_ci if ((of_device_is_compatible(np, "fsl,mpc8540-pci") || 3058c2ecf20Sopenharmony_ci of_device_is_compatible(np, "fsl,mpc8548-pcie")) && 3068c2ecf20Sopenharmony_ci of_device_is_available(np)) 3078c2ecf20Sopenharmony_ci return; 3088c2ecf20Sopenharmony_ci } 3098c2ecf20Sopenharmony_ci#endif 3108c2ecf20Sopenharmony_ci} 3118c2ecf20Sopenharmony_ci 3128c2ecf20Sopenharmony_ci/* 3138c2ecf20Sopenharmony_ci * Setup the architecture 3148c2ecf20Sopenharmony_ci */ 3158c2ecf20Sopenharmony_cistatic void __init mpc85xx_cds_setup_arch(void) 3168c2ecf20Sopenharmony_ci{ 3178c2ecf20Sopenharmony_ci struct device_node *np; 3188c2ecf20Sopenharmony_ci int cds_pci_slot; 3198c2ecf20Sopenharmony_ci 3208c2ecf20Sopenharmony_ci if (ppc_md.progress) 3218c2ecf20Sopenharmony_ci ppc_md.progress("mpc85xx_cds_setup_arch()", 0); 3228c2ecf20Sopenharmony_ci 3238c2ecf20Sopenharmony_ci np = of_find_compatible_node(NULL, NULL, "fsl,mpc8548cds-fpga"); 3248c2ecf20Sopenharmony_ci if (!np) { 3258c2ecf20Sopenharmony_ci pr_err("Could not find FPGA node.\n"); 3268c2ecf20Sopenharmony_ci return; 3278c2ecf20Sopenharmony_ci } 3288c2ecf20Sopenharmony_ci 3298c2ecf20Sopenharmony_ci cadmus = of_iomap(np, 0); 3308c2ecf20Sopenharmony_ci of_node_put(np); 3318c2ecf20Sopenharmony_ci if (!cadmus) { 3328c2ecf20Sopenharmony_ci pr_err("Fail to map FPGA area.\n"); 3338c2ecf20Sopenharmony_ci return; 3348c2ecf20Sopenharmony_ci } 3358c2ecf20Sopenharmony_ci 3368c2ecf20Sopenharmony_ci if (ppc_md.progress) { 3378c2ecf20Sopenharmony_ci char buf[40]; 3388c2ecf20Sopenharmony_ci cds_pci_slot = ((in_8(&cadmus->cm_csr) >> 6) & 0x3) + 1; 3398c2ecf20Sopenharmony_ci snprintf(buf, 40, "CDS Version = 0x%x in slot %d\n", 3408c2ecf20Sopenharmony_ci in_8(&cadmus->cm_ver), cds_pci_slot); 3418c2ecf20Sopenharmony_ci ppc_md.progress(buf, 0); 3428c2ecf20Sopenharmony_ci } 3438c2ecf20Sopenharmony_ci 3448c2ecf20Sopenharmony_ci#ifdef CONFIG_PCI 3458c2ecf20Sopenharmony_ci ppc_md.pci_irq_fixup = mpc85xx_cds_pci_irq_fixup; 3468c2ecf20Sopenharmony_ci ppc_md.pci_exclude_device = mpc85xx_exclude_device; 3478c2ecf20Sopenharmony_ci#endif 3488c2ecf20Sopenharmony_ci 3498c2ecf20Sopenharmony_ci mpc85xx_cds_pci_assign_primary(); 3508c2ecf20Sopenharmony_ci fsl_pci_assign_primary(); 3518c2ecf20Sopenharmony_ci} 3528c2ecf20Sopenharmony_ci 3538c2ecf20Sopenharmony_cistatic void mpc85xx_cds_show_cpuinfo(struct seq_file *m) 3548c2ecf20Sopenharmony_ci{ 3558c2ecf20Sopenharmony_ci uint pvid, svid, phid1; 3568c2ecf20Sopenharmony_ci 3578c2ecf20Sopenharmony_ci pvid = mfspr(SPRN_PVR); 3588c2ecf20Sopenharmony_ci svid = mfspr(SPRN_SVR); 3598c2ecf20Sopenharmony_ci 3608c2ecf20Sopenharmony_ci seq_printf(m, "Vendor\t\t: Freescale Semiconductor\n"); 3618c2ecf20Sopenharmony_ci seq_printf(m, "Machine\t\t: MPC85xx CDS (0x%x)\n", 3628c2ecf20Sopenharmony_ci in_8(&cadmus->cm_ver)); 3638c2ecf20Sopenharmony_ci seq_printf(m, "PVR\t\t: 0x%x\n", pvid); 3648c2ecf20Sopenharmony_ci seq_printf(m, "SVR\t\t: 0x%x\n", svid); 3658c2ecf20Sopenharmony_ci 3668c2ecf20Sopenharmony_ci /* Display cpu Pll setting */ 3678c2ecf20Sopenharmony_ci phid1 = mfspr(SPRN_HID1); 3688c2ecf20Sopenharmony_ci seq_printf(m, "PLL setting\t: 0x%x\n", ((phid1 >> 24) & 0x3f)); 3698c2ecf20Sopenharmony_ci} 3708c2ecf20Sopenharmony_ci 3718c2ecf20Sopenharmony_ci 3728c2ecf20Sopenharmony_ci/* 3738c2ecf20Sopenharmony_ci * Called very early, device-tree isn't unflattened 3748c2ecf20Sopenharmony_ci */ 3758c2ecf20Sopenharmony_cistatic int __init mpc85xx_cds_probe(void) 3768c2ecf20Sopenharmony_ci{ 3778c2ecf20Sopenharmony_ci return of_machine_is_compatible("MPC85xxCDS"); 3788c2ecf20Sopenharmony_ci} 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_cimachine_arch_initcall(mpc85xx_cds, mpc85xx_common_publish_devices); 3818c2ecf20Sopenharmony_ci 3828c2ecf20Sopenharmony_cidefine_machine(mpc85xx_cds) { 3838c2ecf20Sopenharmony_ci .name = "MPC85xx CDS", 3848c2ecf20Sopenharmony_ci .probe = mpc85xx_cds_probe, 3858c2ecf20Sopenharmony_ci .setup_arch = mpc85xx_cds_setup_arch, 3868c2ecf20Sopenharmony_ci .init_IRQ = mpc85xx_cds_pic_init, 3878c2ecf20Sopenharmony_ci .show_cpuinfo = mpc85xx_cds_show_cpuinfo, 3888c2ecf20Sopenharmony_ci .get_irq = mpic_get_irq, 3898c2ecf20Sopenharmony_ci#ifdef CONFIG_PCI 3908c2ecf20Sopenharmony_ci .pcibios_fixup_bus = mpc85xx_cds_fixup_bus, 3918c2ecf20Sopenharmony_ci .pcibios_fixup_phb = fsl_pcibios_fixup_phb, 3928c2ecf20Sopenharmony_ci#endif 3938c2ecf20Sopenharmony_ci .calibrate_decr = generic_calibrate_decr, 3948c2ecf20Sopenharmony_ci .progress = udbg_progress, 3958c2ecf20Sopenharmony_ci}; 396