|
@@ -1,271 +0,0 @@
|
|
-/*
|
|
|
|
- * Copyright 2001 MontaVista Software Inc.
|
|
|
|
- * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
|
|
|
|
- *
|
|
|
|
- * arch/mips/ddb5xxx/ddb5476/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.
|
|
|
|
- *
|
|
|
|
- */
|
|
|
|
-#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 DDB5476, we have one set of swap registers
|
|
|
|
- */
|
|
|
|
-struct pci_config_swap ext_pci_swap = {
|
|
|
|
- DDB_PCIW0,
|
|
|
|
- DDB_PCIINIT0,
|
|
|
|
- DDB_PCI_CONFIG_BASE,
|
|
|
|
- DDB_PCI_CONFIG_SIZE
|
|
|
|
-};
|
|
|
|
-
|
|
|
|
-static int pci_config_workaround = 1;
|
|
|
|
-
|
|
|
|
-/*
|
|
|
|
- * 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 = swap->config_base;
|
|
|
|
- u32 option;
|
|
|
|
-
|
|
|
|
- if (pci_config_workaround) {
|
|
|
|
- if (slot_num == 5)
|
|
|
|
- slot_num = 14;
|
|
|
|
- } else {
|
|
|
|
- if (slot_num == 5)
|
|
|
|
- return DDB_BASE + DDB_PCI_BASE;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- /* 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 = 0x00040000 << slot_num;
|
|
|
|
- } else {
|
|
|
|
- /* type 1 config */
|
|
|
|
- pci_addr = 0x00040000 << slot_num;
|
|
|
|
- panic
|
|
|
|
- ("ddb_access_config_base: we don't support type 1 config Yet");
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- /*
|
|
|
|
- * 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_dev *dev, u32 where, u32 * val)
|
|
|
|
-{
|
|
|
|
- u32 bus, slot_num, func_num;
|
|
|
|
- u32 base;
|
|
|
|
-
|
|
|
|
- db_assert((where & 3) == 0);
|
|
|
|
- db_assert(where < (1 << 8));
|
|
|
|
-
|
|
|
|
- /* check if the bus is top-level */
|
|
|
|
- if (dev->bus->parent != NULL) {
|
|
|
|
- bus = dev->bus->number;
|
|
|
|
- db_assert(bus != 0);
|
|
|
|
- } else {
|
|
|
|
- bus = 0;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- slot_num = PCI_SLOT(dev->devfn);
|
|
|
|
- func_num = PCI_FUNC(dev->devfn);
|
|
|
|
- base = ddb_access_config_base(swap, bus, 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_dev *dev, u32 where, u16 * val)
|
|
|
|
-{
|
|
|
|
- int status;
|
|
|
|
- u32 result;
|
|
|
|
-
|
|
|
|
- db_assert((where & 1) == 0);
|
|
|
|
-
|
|
|
|
- status = read_config_dword(swap, dev, 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_dev *dev, u32 where, u8 * val)
|
|
|
|
-{
|
|
|
|
- int status;
|
|
|
|
- u32 result;
|
|
|
|
-
|
|
|
|
- status = read_config_dword(swap, dev, 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_dev *dev, u32 where, u32 val)
|
|
|
|
-{
|
|
|
|
- u32 bus, slot_num, func_num;
|
|
|
|
- u32 base;
|
|
|
|
-
|
|
|
|
- db_assert((where & 3) == 0);
|
|
|
|
- db_assert(where < (1 << 8));
|
|
|
|
-
|
|
|
|
- /* check if the bus is top-level */
|
|
|
|
- if (dev->bus->parent != NULL) {
|
|
|
|
- bus = dev->bus->number;
|
|
|
|
- db_assert(bus != 0);
|
|
|
|
- } else {
|
|
|
|
- bus = 0;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- slot_num = PCI_SLOT(dev->devfn);
|
|
|
|
- func_num = PCI_FUNC(dev->devfn);
|
|
|
|
- base = ddb_access_config_base(swap, bus, 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_dev *dev, u32 where, u16 val)
|
|
|
|
-{
|
|
|
|
- int status, shift = 0;
|
|
|
|
- u32 result;
|
|
|
|
-
|
|
|
|
- db_assert((where & 1) == 0);
|
|
|
|
-
|
|
|
|
- status = read_config_dword(swap, dev, 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, dev, where & ~3, result);
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-static int write_config_byte(struct pci_config_swap *swap,
|
|
|
|
- struct pci_dev *dev, u32 where, u8 val)
|
|
|
|
-{
|
|
|
|
- int status, shift = 0;
|
|
|
|
- u32 result;
|
|
|
|
-
|
|
|
|
- status = read_config_dword(swap, dev, 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, dev, where & ~3, result);
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-#define MAKE_PCI_OPS(prefix, rw, unitname, unittype, pciswap) \
|
|
|
|
-static int prefix##_##rw##_config_##unitname(struct pci_dev *dev, int where, unittype val) \
|
|
|
|
-{ \
|
|
|
|
- return rw##_config_##unitname(pciswap, \
|
|
|
|
- dev, \
|
|
|
|
- where, \
|
|
|
|
- val); \
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-MAKE_PCI_OPS(extpci, read, byte, u8 *, &ext_pci_swap)
|
|
|
|
- MAKE_PCI_OPS(extpci, read, word, u16 *, &ext_pci_swap)
|
|
|
|
- MAKE_PCI_OPS(extpci, read, dword, u32 *, &ext_pci_swap)
|
|
|
|
-
|
|
|
|
- MAKE_PCI_OPS(extpci, write, byte, u8, &ext_pci_swap)
|
|
|
|
- MAKE_PCI_OPS(extpci, write, word, u16, &ext_pci_swap)
|
|
|
|
- MAKE_PCI_OPS(extpci, write, dword, u32, &ext_pci_swap)
|
|
|
|
-
|
|
|
|
-struct pci_ops ddb5476_ext_pci_ops = {
|
|
|
|
- extpci_read_config_byte,
|
|
|
|
- extpci_read_config_word,
|
|
|
|
- extpci_read_config_dword,
|
|
|
|
- extpci_write_config_byte,
|
|
|
|
- extpci_write_config_word,
|
|
|
|
- extpci_write_config_dword
|
|
|
|
-};
|
|
|