[MIPS] TXx9: PCI fixes for tx3927/tx4927
[linux-2.6] / arch / mips / pci / ops-vr41xx.c
1 /*
2  *  ops-vr41xx.c, PCI configuration routines for the PCIU of NEC VR4100 series.
3  *
4  *  Copyright (C) 2001-2003 MontaVista Software Inc.
5  *    Author: Yoichi Yuasa <yyuasa@mvista.com or source@mvista.com>
6  *  Copyright (C) 2004-2005  Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp>
7  *
8  *  This program is free software; you can redistribute it and/or modify
9  *  it under the terms of the GNU General Public License as published by
10  *  the Free Software Foundation; either version 2 of the License, or
11  *  (at your option) any later version.
12  *
13  *  This program is distributed in the hope that it will be useful,
14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  *  GNU General Public License for more details.
17  *
18  *  You should have received a copy of the GNU General Public License
19  *  along with this program; if not, write to the Free Software
20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21  */
22 /*
23  * Changes:
24  *  MontaVista Software Inc. <yyuasa@mvista.com> or <source@mvista.com>
25  *  - New creation, NEC VR4122 and VR4131 are supported.
26  */
27 #include <linux/pci.h>
28 #include <linux/types.h>
29
30 #include <asm/io.h>
31
32 #define PCICONFDREG     (void __iomem *)KSEG1ADDR(0x0f000c14)
33 #define PCICONFAREG     (void __iomem *)KSEG1ADDR(0x0f000c18)
34
35 static inline int set_pci_configuration_address(unsigned char number,
36                                                 unsigned int devfn, int where)
37 {
38         if (number == 0) {
39                 /*
40                  * Type 0 configuration
41                  */
42                 if (PCI_SLOT(devfn) < 11 || where > 0xff)
43                         return -EINVAL;
44
45                 writel((1U << PCI_SLOT(devfn)) | (PCI_FUNC(devfn) << 8) |
46                        (where & 0xfc), PCICONFAREG);
47         } else {
48                 /*
49                  * Type 1 configuration
50                  */
51                 if (where > 0xff)
52                         return -EINVAL;
53
54                 writel(((uint32_t)number << 16) | ((devfn & 0xff) << 8) |
55                        (where & 0xfc) | 1U, PCICONFAREG);
56         }
57
58         return 0;
59 }
60
61 static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
62                            int size, uint32_t *val)
63 {
64         uint32_t data;
65
66         *val = 0xffffffffU;
67         if (set_pci_configuration_address(bus->number, devfn, where) < 0)
68                 return PCIBIOS_DEVICE_NOT_FOUND;
69
70         data = readl(PCICONFDREG);
71
72         switch (size) {
73         case 1:
74                 *val = (data >> ((where & 3) << 3)) & 0xffU;
75                 break;
76         case 2:
77                 *val = (data >> ((where & 2) << 3)) & 0xffffU;
78                 break;
79         case 4:
80                 *val = data;
81                 break;
82         default:
83                 return PCIBIOS_FUNC_NOT_SUPPORTED;
84         }
85
86         return PCIBIOS_SUCCESSFUL;
87 }
88
89 static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
90                             int size, uint32_t val)
91 {
92         uint32_t data;
93         int shift;
94
95         if (set_pci_configuration_address(bus->number, devfn, where) < 0)
96                 return PCIBIOS_DEVICE_NOT_FOUND;
97
98         data = readl(PCICONFDREG);
99
100         switch (size) {
101         case 1:
102                 shift = (where & 3) << 3;
103                 data &= ~(0xffU << shift);
104                 data |= ((val & 0xffU) << shift);
105                 break;
106         case 2:
107                 shift = (where & 2) << 3;
108                 data &= ~(0xffffU << shift);
109                 data |= ((val & 0xffffU) << shift);
110                 break;
111         case 4:
112                 data = val;
113                 break;
114         default:
115                 return PCIBIOS_FUNC_NOT_SUPPORTED;
116         }
117
118         writel(data, PCICONFDREG);
119
120         return PCIBIOS_SUCCESSFUL;
121 }
122
123 struct pci_ops vr41xx_pci_ops = {
124         .read   = pci_config_read,
125         .write  = pci_config_write,
126 };