Merge branches 'topic/fix/asoc', 'topic/fix/hda', 'topic/fix/misc' and 'topic/pci...
[linux-2.6] / 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 };