1 files changed, 278 insertions, 0 deletions

diff --git a/arch/mips/pci/ops-ddb5477.c b/arch/mips/pci/ops-ddb5477.c
new file mode 100644
index 000000000000..e955443fedf9
--- /dev/null
+++ b/arch/mips/pci/ops-ddb5477.c
@@ -0,0 +1,278 @@
+/***********************************************************************
+ * Copyright 2001 MontaVista Software Inc.
+ * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
+ *
+ * arch/mips/ddb5xxx/ddb5477/pci_ops.c
+ *     Define the pci_ops for DB5477.
+ *
+ * Much of the code is derived from the original DDB5074 port by
+ * Geert Uytterhoeven <geert@sonycom.com>
+ *
+ * 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.
+ ***********************************************************************
+ */
+
+/*
+ * DDB5477 has two PCI channels, external PCI and IOPIC (internal)
+ * Therefore we provide two sets of pci_ops.
+ */
+#include <linux/pci.h>
+#include <linux/kernel.h>
+#include <linux/types.h>
+
+#include <asm/addrspace.h>
+#include <asm/debug.h>
+
+#include <asm/ddb5xxx/ddb5xxx.h>
+
+/*
+ * config_swap structure records what set of pdar/pmr are used
+ * to access pci config space.  It also provides a place hold the
+ * original values for future restoring.
+ */
+struct pci_config_swap {
+        u32 pdar;
+        u32 pmr;
+        u32 config_base;
+        u32 config_size;
+        u32 pdar_backup;
+        u32 pmr_backup;
+};
+
+/*
+ * On DDB5477, we have two sets of swap registers, for ext PCI and IOPCI.
+ */
+struct pci_config_swap ext_pci_swap = {
+        DDB_PCIW0,
+        DDB_PCIINIT00,
+        DDB_PCI0_CONFIG_BASE,
+        DDB_PCI0_CONFIG_SIZE
+};
+struct pci_config_swap io_pci_swap = {
+        DDB_IOPCIW0,
+        DDB_PCIINIT01,
+        DDB_PCI1_CONFIG_BASE,
+        DDB_PCI1_CONFIG_SIZE
+};
+
+
+/*
+ * access config space
+ */
+static inline u32 ddb_access_config_base(struct pci_config_swap *swap, u32 bus, /* 0 means top level bus */
+                                         u32 slot_num)
+{
+        u32 pci_addr = 0;
+        u32 pciinit_offset = 0;
+        u32 virt_addr;
+        u32 option;
+
+        /* minimum pdar (window) size is 2MB */
+        db_assert(swap->config_size >= (2 << 20));
+
+        db_assert(slot_num < (1 << 5));
+        db_assert(bus < (1 << 8));
+
+        /* backup registers */
+        swap->pdar_backup = ddb_in32(swap->pdar);
+        swap->pmr_backup = ddb_in32(swap->pmr);
+
+        /* set the pdar (pci window) register */
+        ddb_set_pdar(swap->pdar, swap->config_base, swap->config_size, 32,      /* 32 bit wide */
+                     0,         /* not on local memory bus */
+                     0);        /* not visible from PCI bus (N/A) */
+
+        /*
+         * calcuate the absolute pci config addr;
+         * according to the spec, we start scanning from adr:11 (0x800)
+         */
+        if (bus == 0) {
+                /* type 0 config */
+                pci_addr = 0x800 << slot_num;
+        } else {
+                /* type 1 config */
+                pci_addr = (bus << 16) | (slot_num << 11);
+        }
+
+        /*
+         * if pci_addr is less than pci config window size,  we set
+         * pciinit_offset to 0 and adjust the virt_address.
+         * Otherwise we will try to adjust pciinit_offset.
+         */
+        if (pci_addr < swap->config_size) {
+                virt_addr = KSEG1ADDR(swap->config_base + pci_addr);
+                pciinit_offset = 0;
+        } else {
+                db_assert((pci_addr & (swap->config_size - 1)) == 0);
+                virt_addr = KSEG1ADDR(swap->config_base);
+                pciinit_offset = pci_addr;
+        }
+
+        /* set the pmr register */
+        option = DDB_PCI_ACCESS_32;
+        if (bus != 0)
+                option |= DDB_PCI_CFGTYPE1;
+        ddb_set_pmr(swap->pmr, DDB_PCICMD_CFG, pciinit_offset, option);
+
+        return virt_addr;
+}
+
+static inline void ddb_close_config_base(struct pci_config_swap *swap)
+{
+        ddb_out32(swap->pdar, swap->pdar_backup);
+        ddb_out32(swap->pmr, swap->pmr_backup);
+}
+
+static int read_config_dword(struct pci_config_swap *swap,
+                             struct pci_bus *bus, u32 devfn, u32 where, 
+                             u32 * val)
+{
+        u32 bus_num, slot_num, func_num;
+        u32 base;
+
+        db_assert((where & 3) == 0);
+        db_assert(where < (1 << 8));
+
+        /* check if the bus is top-level */
+        if (bus->parent != NULL) {
+                bus_num = bus->number;
+                db_assert(bus_num != 0);
+        } else {
+                bus_num = 0;
+        }
+
+        slot_num = PCI_SLOT(devfn);
+        func_num = PCI_FUNC(devfn);
+        base = ddb_access_config_base(swap, bus_num, slot_num);
+        *val = *(volatile u32 *) (base + (func_num << 8) + where);
+        ddb_close_config_base(swap);
+        return PCIBIOS_SUCCESSFUL;
+}
+
+static int read_config_word(struct pci_config_swap *swap,
+                            struct pci_bus *bus, u32 devfn, u32 where, 
+                            u16 * val)
+{
+        int status;
+        u32 result;
+
+        db_assert((where & 1) == 0);
+
+        status = read_config_dword(swap, bus, devfn, where & ~3, &result);
+        if (where & 2)
+                result >>= 16;
+        *val = result & 0xffff;
+        return status;
+}
+
+static int read_config_byte(struct pci_config_swap *swap,
+                            struct pci_bus *bus, u32 devfn, u32 where,
+                            u8 * val)
+{
+        int status;
+        u32 result;
+
+        status = read_config_dword(swap, bus, devfn, where & ~3, &result);
+        if (where & 1)
+                result >>= 8;
+        if (where & 2)
+                result >>= 16;
+        *val = result & 0xff;
+
+        return status;
+}
+
+static int write_config_dword(struct pci_config_swap *swap,
+                              struct pci_bus *bus, u32 devfn, u32 where,
+                              u32 val)
+{
+        u32 bus_num, slot_num, func_num;
+        u32 base;
+
+        db_assert((where & 3) == 0);
+        db_assert(where < (1 << 8));
+
+        /* check if the bus is top-level */
+        if (bus->parent != NULL) {
+                bus_num = bus->number;
+                db_assert(bus_num != 0);
+        } else {
+                bus_num = 0;
+        }
+
+        slot_num = PCI_SLOT(devfn);
+        func_num = PCI_FUNC(devfn);
+        base = ddb_access_config_base(swap, bus_num, slot_num);
+        *(volatile u32 *) (base + (func_num << 8) + where) = val;
+        ddb_close_config_base(swap);
+        return PCIBIOS_SUCCESSFUL;
+}
+
+static int write_config_word(struct pci_config_swap *swap,
+                             struct pci_bus *bus, u32 devfn, u32 where, u16 val)
+{
+        int status, shift = 0;
+        u32 result;
+
+        db_assert((where & 1) == 0);
+
+        status = read_config_dword(swap, bus, devfn, where & ~3, &result);
+        if (status != PCIBIOS_SUCCESSFUL)
+                return status;
+
+        if (where & 2)
+                shift += 16;
+        result &= ~(0xffff << shift);
+        result |= val << shift;
+        return write_config_dword(swap, bus, devfn, where & ~3, result);
+}
+
+static int write_config_byte(struct pci_config_swap *swap,
+                             struct pci_bus *bus, u32 devfn, u32 where, u8 val)
+{
+        int status, shift = 0;
+        u32 result;
+
+        status = read_config_dword(swap, bus, devfn, where & ~3, &result);
+        if (status != PCIBIOS_SUCCESSFUL)
+                return status;
+
+        if (where & 2)
+                shift += 16;
+        if (where & 1)
+                shift += 8;
+        result &= ~(0xff << shift);
+        result |= val << shift;
+        return write_config_dword(swap, bus, devfn, where & ~3, result);
+}
+
+#define        MAKE_PCI_OPS(prefix, rw, pciswap, star) \
+static int prefix##_##rw##_config(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 star val) \
+{ \
+        if (size == 1) \
+                return rw##_config_byte(pciswap, bus, devfn, where, (u8 star)val); \
+        else if (size == 2) \
+                return rw##_config_word(pciswap, bus, devfn, where, (u16 star)val); \
+        /* Size must be 4 */ \
+        return rw##_config_dword(pciswap, bus, devfn, where, val); \
+}
+
+MAKE_PCI_OPS(extpci, read, &ext_pci_swap, *)
+MAKE_PCI_OPS(extpci, write, &ext_pci_swap,)
+
+MAKE_PCI_OPS(iopci, read, &io_pci_swap, *)
+MAKE_PCI_OPS(iopci, write, &io_pci_swap,)
+
+struct pci_ops ddb5477_ext_pci_ops = {
+        .read = extpci_read_config,
+        .write = extpci_write_config
+};
+
+
+struct pci_ops ddb5477_io_pci_ops = {
+        .read = iopci_read_config,
+        .write = iopci_write_config
+};