|  | /* | 
|  | * This file is subject to the terms and conditions of the GNU General Public | 
|  | * License.  See the file "COPYING" in the main directory of this archive | 
|  | * for more details. | 
|  | * | 
|  | * SNI specific PCI support for RM200/RM300. | 
|  | * | 
|  | * Copyright (C) 1997 - 2000, 2003 Ralf Baechle <ralf@linux-mips.org> | 
|  | */ | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/pci.h> | 
|  | #include <linux/types.h> | 
|  | #include <asm/sni.h> | 
|  |  | 
|  | /* | 
|  | * It seems that on the RM200 only lower 3 bits of the 5 bit PCI device | 
|  | * address are decoded.  We therefore manually have to reject attempts at | 
|  | * reading outside this range.  Being on the paranoid side we only do this | 
|  | * test for bus 0 and hope forwarding and decoding work properly for any | 
|  | * subordinated busses. | 
|  | * | 
|  | * ASIC PCI only supports type 1 config cycles. | 
|  | */ | 
|  | static int set_config_address(unsigned int busno, unsigned int devfn, int reg) | 
|  | { | 
|  | if ((devfn > 255) || (reg > 255)) | 
|  | return PCIBIOS_BAD_REGISTER_NUMBER; | 
|  |  | 
|  | if (busno == 0 && devfn >= PCI_DEVFN(8, 0)) | 
|  | return PCIBIOS_DEVICE_NOT_FOUND; | 
|  |  | 
|  | *(volatile u32 *)PCIMT_CONFIG_ADDRESS = | 
|  | ((busno    & 0xff) << 16) | | 
|  | ((devfn    & 0xff) <<  8) | | 
|  | (reg      & 0xfc); | 
|  |  | 
|  | return PCIBIOS_SUCCESSFUL; | 
|  | } | 
|  |  | 
|  | static int pcimt_read(struct pci_bus *bus, unsigned int devfn, int reg, | 
|  | int size, u32 * val) | 
|  | { | 
|  | int res; | 
|  |  | 
|  | if ((res = set_config_address(bus->number, devfn, reg))) | 
|  | return res; | 
|  |  | 
|  | switch (size) { | 
|  | case 1: | 
|  | *val = inb(PCIMT_CONFIG_DATA + (reg & 3)); | 
|  | break; | 
|  | case 2: | 
|  | *val = inw(PCIMT_CONFIG_DATA + (reg & 2)); | 
|  | break; | 
|  | case 4: | 
|  | *val = inl(PCIMT_CONFIG_DATA); | 
|  | break; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int pcimt_write(struct pci_bus *bus, unsigned int devfn, int reg, | 
|  | int size, u32 val) | 
|  | { | 
|  | int res; | 
|  |  | 
|  | if ((res = set_config_address(bus->number, devfn, reg))) | 
|  | return res; | 
|  |  | 
|  | switch (size) { | 
|  | case 1: | 
|  | outb(val, PCIMT_CONFIG_DATA + (reg & 3)); | 
|  | break; | 
|  | case 2: | 
|  | outw(val, PCIMT_CONFIG_DATA + (reg & 2)); | 
|  | break; | 
|  | case 4: | 
|  | outl(val, PCIMT_CONFIG_DATA); | 
|  | break; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | struct pci_ops sni_pcimt_ops = { | 
|  | .read = pcimt_read, | 
|  | .write = pcimt_write, | 
|  | }; | 
|  |  | 
|  | static int pcit_set_config_address(unsigned int busno, unsigned int devfn, int reg) | 
|  | { | 
|  | if ((devfn > 255) || (reg > 255) || (busno > 255)) | 
|  | return PCIBIOS_BAD_REGISTER_NUMBER; | 
|  |  | 
|  | outl((1 << 31) | ((busno & 0xff) << 16) | ((devfn & 0xff) << 8) | (reg & 0xfc), 0xcf8); | 
|  | return PCIBIOS_SUCCESSFUL; | 
|  | } | 
|  |  | 
|  | static int pcit_read(struct pci_bus *bus, unsigned int devfn, int reg, | 
|  | int size, u32 * val) | 
|  | { | 
|  | int res; | 
|  |  | 
|  | /* | 
|  | * on bus 0 we need to check, whether there is a device answering | 
|  | * for the devfn by doing a config write and checking the result. If | 
|  | * we don't do it, we will get a data bus error | 
|  | */ | 
|  | if (bus->number == 0) { | 
|  | pcit_set_config_address(0, 0, 0x68); | 
|  | outl(inl(0xcfc) | 0xc0000000, 0xcfc); | 
|  | if ((res = pcit_set_config_address(0, devfn, 0))) | 
|  | return res; | 
|  | outl(0xffffffff, 0xcfc); | 
|  | pcit_set_config_address(0, 0, 0x68); | 
|  | if (inl(0xcfc) & 0x100000) | 
|  | return PCIBIOS_DEVICE_NOT_FOUND; | 
|  | } | 
|  | if ((res = pcit_set_config_address(bus->number, devfn, reg))) | 
|  | return res; | 
|  |  | 
|  | switch (size) { | 
|  | case 1: | 
|  | *val = inb(PCIMT_CONFIG_DATA + (reg & 3)); | 
|  | break; | 
|  | case 2: | 
|  | *val = inw(PCIMT_CONFIG_DATA + (reg & 2)); | 
|  | break; | 
|  | case 4: | 
|  | *val = inl(PCIMT_CONFIG_DATA); | 
|  | break; | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int pcit_write(struct pci_bus *bus, unsigned int devfn, int reg, | 
|  | int size, u32 val) | 
|  | { | 
|  | int res; | 
|  |  | 
|  | if ((res = pcit_set_config_address(bus->number, devfn, reg))) | 
|  | return res; | 
|  |  | 
|  | switch (size) { | 
|  | case 1: | 
|  | outb(val, PCIMT_CONFIG_DATA + (reg & 3)); | 
|  | break; | 
|  | case 2: | 
|  | outw(val, PCIMT_CONFIG_DATA + (reg & 2)); | 
|  | break; | 
|  | case 4: | 
|  | outl(val, PCIMT_CONFIG_DATA); | 
|  | break; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | struct pci_ops sni_pcit_ops = { | 
|  | .read = pcit_read, | 
|  | .write = pcit_write, | 
|  | }; |