arch/mips/pci/ops-bonito64.c

   1 /*
   2  * Copyright (C) 1999, 2000, 2004  MIPS Technologies, Inc.
   3  *      All rights reserved.
   4  *      Authors: Carsten Langgaard <carstenl@mips.com>
   5  *               Maciej W. Rozycki <macro@mips.com>
   6  *
   7  *  This program is free software; you can distribute it and/or modify it
   8  *  under the terms of the GNU General Public License (Version 2) as
   9  *  published by the Free Software Foundation.
  10  *
  11  *  This program is distributed in the hope it will be useful, but WITHOUT
  12  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  14  *  for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License along
  17  *  with this program; if not, write to the Free Software Foundation, Inc.,
  18  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  19  *
  20  * MIPS boards specific PCI support.
  21  */
  22 #include <linux/types.h>
  23 #include <linux/pci.h>
  24 #include <linux/kernel.h>
  25 #include <linux/init.h>
  26
  27 #include <asm/mips-boards/bonito64.h>
  28
  29 #define PCI_ACCESS_READ  0
  30 #define PCI_ACCESS_WRITE 1
  31
  32 #ifdef CONFIG_LEMOTE_FULOONG2E
  33 #define CFG_SPACE_REG(offset) (void *)CKSEG1ADDR(BONITO_PCICFG_BASE | (offset))
  34 #define ID_SEL_BEGIN 11
  35 #else
  36 #define CFG_SPACE_REG(offset) (void *)CKSEG1ADDR(_pcictrl_bonito_pcicfg + (offset))
  37 #define ID_SEL_BEGIN 10
  38 #endif
  39 #define MAX_DEV_NUM (31 - ID_SEL_BEGIN)
  40
  41
  42 static int bonito64_pcibios_config_access(unsigned char access_type,
  43                                       struct pci_bus *bus,
  44                                       unsigned int devfn, int where,
  45                                       u32 * data)
  46 {
  47         u32 busnum = bus->number;
  48         u32 addr, type;
  49         u32 dummy;
  50         void *addrp;
  51         int device = PCI_SLOT(devfn);
  52         int function = PCI_FUNC(devfn);
  53         int reg = where & ~3;
  54
  55         if (busnum == 0) {
  56                 /* Type 0 configuration for onboard PCI bus */
  57                 if (device > MAX_DEV_NUM)
  58                         return -1;
  59
  60                 addr = (1 << (device + ID_SEL_BEGIN)) | (function << 8) | reg;
  61                 type = 0;
  62         } else {
  63                 /* Type 1 configuration for offboard PCI bus */
  64                 addr = (busnum << 16) | (device << 11) | (function << 8) | reg;
  65                 type = 0x10000;
  66         }
  67
  68         /* Clear aborts */
  69         BONITO_PCICMD |= BONITO_PCICMD_MABORT_CLR | BONITO_PCICMD_MTABORT_CLR;
  70
  71         BONITO_PCIMAP_CFG = (addr >> 16) | type;
  72
  73         /* Flush Bonito register block */
  74         dummy = BONITO_PCIMAP_CFG;
  75         mmiowb();
  76
  77         addrp = CFG_SPACE_REG(addr & 0xffff);
  78         if (access_type == PCI_ACCESS_WRITE) {
  79                 writel(cpu_to_le32(*data), addrp);
  80 #ifndef CONFIG_LEMOTE_FULOONG2E
  81                 /* Wait till done */
  82                 while (BONITO_PCIMSTAT & 0xF);
  83 #endif
  84         } else {
  85                 *data = le32_to_cpu(readl(addrp));
  86         }
  87
  88         /* Detect Master/Target abort */
  89         if (BONITO_PCICMD & (BONITO_PCICMD_MABORT_CLR |
  90                              BONITO_PCICMD_MTABORT_CLR)) {
  91                 /* Error occurred */
  92
  93                 /* Clear bits */
  94                 BONITO_PCICMD |= (BONITO_PCICMD_MABORT_CLR |
  95                                   BONITO_PCICMD_MTABORT_CLR);
  96
  97                 return -1;
  98         }
  99
 100         return 0;
 101
 102 }
 103
 104
 105 /*
 106  * We can't address 8 and 16 bit words directly.  Instead we have to
 107  * read/write a 32bit word and mask/modify the data we actually want.
 108  */
 109 static int bonito64_pcibios_read(struct pci_bus *bus, unsigned int devfn,
 110                              int where, int size, u32 * val)
 111 {
 112         u32 data = 0;
 113
 114         if ((size == 2) && (where & 1))
 115                 return PCIBIOS_BAD_REGISTER_NUMBER;
 116         else if ((size == 4) && (where & 3))
 117                 return PCIBIOS_BAD_REGISTER_NUMBER;
 118
 119         if (bonito64_pcibios_config_access(PCI_ACCESS_READ, bus, devfn, where,
 120                                        &data))
 121                 return -1;
 122
 123         if (size == 1)
 124                 *val = (data >> ((where & 3) << 3)) & 0xff;
 125         else if (size == 2)
 126                 *val = (data >> ((where & 3) << 3)) & 0xffff;
 127         else
 128                 *val = data;
 129
 130         return PCIBIOS_SUCCESSFUL;
 131 }
 132
 133 static int bonito64_pcibios_write(struct pci_bus *bus, unsigned int devfn,
 134                               int where, int size, u32 val)
 135 {
 136         u32 data = 0;
 137
 138         if ((size == 2) && (where & 1))
 139                 return PCIBIOS_BAD_REGISTER_NUMBER;
 140         else if ((size == 4) && (where & 3))
 141                 return PCIBIOS_BAD_REGISTER_NUMBER;
 142
 143         if (size == 4)
 144                 data = val;
 145         else {
 146                 if (bonito64_pcibios_config_access(PCI_ACCESS_READ, bus, devfn,
 147                                                where, &data))
 148                         return -1;
 149
 150                 if (size == 1)
 151                         data = (data & ~(0xff << ((where & 3) << 3))) |
 152                                 (val << ((where & 3) << 3));
 153                 else if (size == 2)
 154                         data = (data & ~(0xffff << ((where & 3) << 3))) |
 155                                 (val << ((where & 3) << 3));
 156         }
 157
 158         if (bonito64_pcibios_config_access(PCI_ACCESS_WRITE, bus, devfn, where,
 159                                        &data))
 160                 return -1;
 161
 162         return PCIBIOS_SUCCESSFUL;
 163 }
 164
 165 struct pci_ops bonito64_pci_ops = {
 166         .read = bonito64_pcibios_read,
 167         .write = bonito64_pcibios_write
 168 };