release/src-rt-6.x.4708/linux/linux-2.6.36/arch/mips/pci/ops-pnx8550.c

   1 /*
   2  *
   3  *  BRIEF MODULE DESCRIPTION
   4  *
   5  *  2.6 port, Embedded Alley Solutions, Inc
   6  *
   7  *  Based on:
   8  *  Author: source@mvista.com
   9  *
  10  *  This program is free software; you can distribute it and/or modify it
  11  *  under the terms of the GNU General Public License (Version 2) as
  12  *  published by the Free Software Foundation.
  13  *
  14  *  This program is distributed in the hope it will be useful, but WITHOUT
  15  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  16  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  17  *  for more details.
  18  *
  19  *  You should have received a copy of the GNU General Public License along
  20  *  with this program; if not, write to the Free Software Foundation, Inc.,
  21  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  22  */
  23 #include <linux/types.h>
  24 #include <linux/pci.h>
  25 #include <linux/kernel.h>
  26 #include <linux/init.h>
  27 #include <linux/vmalloc.h>
  28 #include <linux/delay.h>
  29
  30 #include <asm/mach-pnx8550/pci.h>
  31 #include <asm/mach-pnx8550/glb.h>
  32
  33 static inline void clear_status(void)
  34 {
  35         unsigned long pci_stat;
  36
  37         pci_stat = inl(PCI_BASE | PCI_GPPM_STATUS);
  38         outl(pci_stat, PCI_BASE | PCI_GPPM_ICLR);
  39 }
  40
  41 static inline unsigned int
  42 calc_cfg_addr(struct pci_bus *bus, unsigned int devfn, int where)
  43 {
  44         unsigned int addr;
  45
  46         addr = ((bus->number > 0) ? (((bus->number & 0xff) << PCI_CFG_BUS_SHIFT) | 1) : 0);
  47         addr |= ((devfn & 0xff) << PCI_CFG_FUNC_SHIFT) | (where & 0xfc);
  48
  49         return addr;
  50 }
  51
  52 static int
  53 config_access(unsigned int pci_cmd, struct pci_bus *bus, unsigned int devfn, int where, unsigned int pci_mode, unsigned int *val)
  54 {
  55         unsigned int flags;
  56         unsigned long loops = 0;
  57         unsigned long ioaddr = calc_cfg_addr(bus, devfn, where);
  58
  59         local_irq_save(flags);
  60         /*Clear pending interrupt status */
  61         if (inl(PCI_BASE | PCI_GPPM_STATUS)) {
  62                 clear_status();
  63                 while (!(inl(PCI_BASE | PCI_GPPM_STATUS) == 0)) ;
  64         }
  65
  66         outl(ioaddr, PCI_BASE | PCI_GPPM_ADDR);
  67
  68         if ((pci_cmd == PCI_CMD_IOW) || (pci_cmd == PCI_CMD_CONFIG_WRITE))
  69                 outl(*val, PCI_BASE | PCI_GPPM_WDAT);
  70
  71         outl(INIT_PCI_CYCLE | pci_cmd | (pci_mode & PCI_BYTE_ENABLE_MASK),
  72              PCI_BASE | PCI_GPPM_CTRL);
  73
  74         loops =
  75             ((loops_per_jiffy *
  76               PCI_IO_JIFFIES_TIMEOUT) >> (PCI_IO_JIFFIES_SHIFT));
  77         while (1) {
  78                 if (inl(PCI_BASE | PCI_GPPM_STATUS) & GPPM_DONE) {
  79                         if ((pci_cmd == PCI_CMD_IOR) ||
  80                             (pci_cmd == PCI_CMD_CONFIG_READ))
  81                                 *val = inl(PCI_BASE | PCI_GPPM_RDAT);
  82                         clear_status();
  83                         local_irq_restore(flags);
  84                         return PCIBIOS_SUCCESSFUL;
  85                 } else if (inl(PCI_BASE | PCI_GPPM_STATUS) & GPPM_R_MABORT) {
  86                         break;
  87                 }
  88
  89                 loops--;
  90                 if (loops == 0) {
  91                         printk("%s : Arbiter Locked.\n", __func__);
  92                 }
  93         }
  94
  95         clear_status();
  96         if ((pci_cmd == PCI_CMD_IOR) || (pci_cmd == PCI_CMD_IOW)) {
  97                 printk("%s timeout (GPPM_CTRL=%X) ioaddr %lX pci_cmd %X\n",
  98                        __func__, inl(PCI_BASE | PCI_GPPM_CTRL), ioaddr,
  99                        pci_cmd);
 100         }
 101
 102         if ((pci_cmd == PCI_CMD_IOR) || (pci_cmd == PCI_CMD_CONFIG_READ))
 103                 *val = 0xffffffff;
 104         local_irq_restore(flags);
 105         return PCIBIOS_DEVICE_NOT_FOUND;
 106 }
 107
 108 /*
 109  * We can't address 8 and 16 bit words directly.  Instead we have to
 110  * read/write a 32bit word and mask/modify the data we actually want.
 111  */
 112 static int
 113 read_config_byte(struct pci_bus *bus, unsigned int devfn, int where, u8 * val)
 114 {
 115         unsigned int data = 0;
 116         int err;
 117
 118         if (bus == NULL)
 119                 return -1;
 120
 121         err = config_access(PCI_CMD_CONFIG_READ, bus, devfn, where, ~(1 << (where & 3)), &data);
 122         switch (where & 0x03) {
 123         case 0:
 124                 *val = (unsigned char)(data & 0x000000ff);
 125                 break;
 126         case 1:
 127                 *val = (unsigned char)((data & 0x0000ff00) >> 8);
 128                 break;
 129         case 2:
 130                 *val = (unsigned char)((data & 0x00ff0000) >> 16);
 131                 break;
 132         case 3:
 133                 *val = (unsigned char)((data & 0xff000000) >> 24);
 134                 break;
 135         }
 136
 137         return err;
 138 }
 139
 140 static int
 141 read_config_word(struct pci_bus *bus, unsigned int devfn, int where, u16 * val)
 142 {
 143         unsigned int data = 0;
 144         int err;
 145
 146         if (bus == NULL)
 147                 return -1;
 148
 149         if (where & 0x01)
 150                 return PCIBIOS_BAD_REGISTER_NUMBER;
 151
 152         err = config_access(PCI_CMD_CONFIG_READ, bus, devfn, where, ~(3 << (where & 3)), &data);
 153         switch (where & 0x02) {
 154         case 0:
 155                 *val = (unsigned short)(data & 0x0000ffff);
 156                 break;
 157         case 2:
 158                 *val = (unsigned short)((data & 0xffff0000) >> 16);
 159                 break;
 160         }
 161
 162         return err;
 163 }
 164
 165 static int
 166 read_config_dword(struct pci_bus *bus, unsigned int devfn, int where, u32 * val)
 167 {
 168         int err;
 169         if (bus == NULL)
 170                 return -1;
 171
 172         if (where & 0x03)
 173                 return PCIBIOS_BAD_REGISTER_NUMBER;
 174
 175         err = config_access(PCI_CMD_CONFIG_READ, bus, devfn, where, 0, val);
 176
 177         return err;
 178 }
 179
 180 static int
 181 write_config_byte(struct pci_bus *bus, unsigned int devfn, int where, u8 val)
 182 {
 183         unsigned int data = (unsigned int)val;
 184         int err;
 185
 186         if (bus == NULL)
 187                 return -1;
 188
 189         switch (where & 0x03) {
 190         case 1:
 191                 data = (data << 8);
 192                 break;
 193         case 2:
 194                 data = (data << 16);
 195                 break;
 196         case 3:
 197                 data = (data << 24);
 198                 break;
 199         default:
 200                 break;
 201         }
 202
 203         err = config_access(PCI_CMD_CONFIG_WRITE, bus, devfn, where, ~(1 << (where & 3)), &data);
 204
 205         return err;
 206 }
 207
 208 static int
 209 write_config_word(struct pci_bus *bus, unsigned int devfn, int where, u16 val)
 210 {
 211         unsigned int data = (unsigned int)val;
 212         int err;
 213
 214         if (bus == NULL)
 215                 return -1;
 216
 217         if (where & 0x01)
 218                 return PCIBIOS_BAD_REGISTER_NUMBER;
 219
 220         switch (where & 0x02) {
 221         case 2:
 222                 data = (data << 16);
 223                 break;
 224         default:
 225                 break;
 226         }
 227         err = config_access(PCI_CMD_CONFIG_WRITE, bus, devfn, where, ~(3 << (where & 3)), &data);
 228
 229         return err;
 230 }
 231
 232 static int
 233 write_config_dword(struct pci_bus *bus, unsigned int devfn, int where, u32 val)
 234 {
 235         int err;
 236         if (bus == NULL)
 237                 return -1;
 238
 239         if (where & 0x03)
 240                 return PCIBIOS_BAD_REGISTER_NUMBER;
 241
 242         err = config_access(PCI_CMD_CONFIG_WRITE, bus, devfn, where, 0, &val);
 243
 244         return err;
 245 }
 246
 247 static int config_read(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 * val)
 248 {
 249         switch (size) {
 250         case 1: {
 251                         u8 _val;
 252                         int rc = read_config_byte(bus, devfn, where, &_val);
 253                         *val = _val;
 254                         return rc;
 255                 }
 256        case 2: {
 257                         u16 _val;
 258                         int rc = read_config_word(bus, devfn, where, &_val);
 259                         *val = _val;
 260                         return rc;
 261                 }
 262         default:
 263                 return read_config_dword(bus, devfn, where, val);
 264         }
 265 }
 266
 267 static int config_write(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 val)
 268 {
 269         switch (size) {
 270         case 1:
 271                 return write_config_byte(bus, devfn, where, (u8) val);
 272         case 2:
 273                 return write_config_word(bus, devfn, where, (u16) val);
 274         default:
 275                 return write_config_dword(bus, devfn, where, val);
 276         }
 277 }
 278
 279 struct pci_ops pnx8550_pci_ops = {
 280         config_read,
 281         config_write
 282 };