Linux 2.6.31-rc6
[linux-2.6] / arch / mips / pci / ops-au1000.c
1 /*
2  * BRIEF MODULE DESCRIPTION
3  *      Alchemy/AMD Au1xx0 PCI support.
4  *
5  * Copyright 2001-2003, 2007-2008 MontaVista Software Inc.
6  * Author: MontaVista Software, Inc. <source@mvista.com>
7  *
8  *  Support for all devices (greater than 16) added by David Gathright.
9  *
10  *  This program is free software; you can redistribute  it and/or modify it
11  *  under  the terms of  the GNU General  Public License as published by the
12  *  Free Software Foundation;  either version 2 of the  License, or (at your
13  *  option) any later version.
14  *
15  *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
16  *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
17  *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
18  *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
19  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20  *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
21  *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
22  *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
23  *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24  *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25  *
26  *  You should have received a copy of the  GNU General Public License along
27  *  with this program; if not, write  to the Free Software Foundation, Inc.,
28  *  675 Mass Ave, Cambridge, MA 02139, USA.
29  */
30
31 #include <linux/types.h>
32 #include <linux/pci.h>
33 #include <linux/kernel.h>
34 #include <linux/init.h>
35 #include <linux/vmalloc.h>
36
37 #include <asm/mach-au1x00/au1000.h>
38
39 #undef  DEBUG
40 #ifdef  DEBUG
41 #define DBG(x...) printk(KERN_DEBUG x)
42 #else
43 #define DBG(x...)
44 #endif
45
46 #define PCI_ACCESS_READ  0
47 #define PCI_ACCESS_WRITE 1
48
49 int (*board_pci_idsel)(unsigned int devsel, int assert);
50
51 void mod_wired_entry(int entry, unsigned long entrylo0,
52                 unsigned long entrylo1, unsigned long entryhi,
53                 unsigned long pagemask)
54 {
55         unsigned long old_pagemask;
56         unsigned long old_ctx;
57
58         /* Save old context and create impossible VPN2 value */
59         old_ctx = read_c0_entryhi() & 0xff;
60         old_pagemask = read_c0_pagemask();
61         write_c0_index(entry);
62         write_c0_pagemask(pagemask);
63         write_c0_entryhi(entryhi);
64         write_c0_entrylo0(entrylo0);
65         write_c0_entrylo1(entrylo1);
66         tlb_write_indexed();
67         write_c0_entryhi(old_ctx);
68         write_c0_pagemask(old_pagemask);
69 }
70
71 static struct vm_struct *pci_cfg_vm;
72 static int pci_cfg_wired_entry;
73 static unsigned long last_entryLo0, last_entryLo1;
74
75 /*
76  * We can't ioremap the entire pci config space because it's too large.
77  * Nor can we call ioremap dynamically because some device drivers use
78  * the PCI config routines from within interrupt handlers and that
79  * becomes a problem in get_vm_area().  We use one wired TLB to handle
80  * all config accesses for all busses.
81  */
82 void __init au1x_pci_cfg_init(void)
83 {
84         /* Reserve a wired entry for PCI config accesses */
85         pci_cfg_vm = get_vm_area(0x2000, VM_IOREMAP);
86         if (!pci_cfg_vm)
87                 panic(KERN_ERR "PCI unable to get vm area\n");
88         pci_cfg_wired_entry = read_c0_wired();
89         add_wired_entry(0, 0, (unsigned long)pci_cfg_vm->addr, PM_4K);
90         last_entryLo0 = last_entryLo1 = 0xffffffff;
91 }
92
93 static int config_access(unsigned char access_type, struct pci_bus *bus,
94                          unsigned int dev_fn, unsigned char where, u32 *data)
95 {
96 #if defined(CONFIG_SOC_AU1500) || defined(CONFIG_SOC_AU1550)
97         unsigned int device = PCI_SLOT(dev_fn);
98         unsigned int function = PCI_FUNC(dev_fn);
99         unsigned long offset, status;
100         unsigned long cfg_base;
101         unsigned long flags;
102         int error = PCIBIOS_SUCCESSFUL;
103         unsigned long entryLo0, entryLo1;
104
105         if (device > 19) {
106                 *data = 0xffffffff;
107                 return -1;
108         }
109
110         local_irq_save(flags);
111         au_writel(((0x2000 << 16) | (au_readl(Au1500_PCI_STATCMD) & 0xffff)),
112                         Au1500_PCI_STATCMD);
113         au_sync_udelay(1);
114
115         /*
116          * Allow board vendors to implement their own off-chip IDSEL.
117          * If it doesn't succeed, may as well bail out at this point.
118          */
119         if (board_pci_idsel && board_pci_idsel(device, 1) == 0) {
120                 *data = 0xffffffff;
121                 local_irq_restore(flags);
122                 return -1;
123         }
124
125         /* Setup the config window */
126         if (bus->number == 0)
127                 cfg_base = (1 << device) << 11;
128         else
129                 cfg_base = 0x80000000 | (bus->number << 16) | (device << 11);
130
131         /* Setup the lower bits of the 36-bit address */
132         offset = (function << 8) | (where & ~0x3);
133         /* Pick up any address that falls below the page mask */
134         offset |= cfg_base & ~PAGE_MASK;
135
136         /* Page boundary */
137         cfg_base = cfg_base & PAGE_MASK;
138
139         /*
140          * To improve performance, if the current device is the same as
141          * the last device accessed, we don't touch the TLB.
142          */
143         entryLo0 = (6 << 26) | (cfg_base >> 6) | (2 << 3) | 7;
144         entryLo1 = (6 << 26) | (cfg_base >> 6) | (0x1000 >> 6) | (2 << 3) | 7;
145         if ((entryLo0 != last_entryLo0) || (entryLo1 != last_entryLo1)) {
146                 mod_wired_entry(pci_cfg_wired_entry, entryLo0, entryLo1,
147                                 (unsigned long)pci_cfg_vm->addr, PM_4K);
148                 last_entryLo0 = entryLo0;
149                 last_entryLo1 = entryLo1;
150         }
151
152         if (access_type == PCI_ACCESS_WRITE)
153                 au_writel(*data, (int)(pci_cfg_vm->addr + offset));
154         else
155                 *data = au_readl((int)(pci_cfg_vm->addr + offset));
156
157         au_sync_udelay(2);
158
159         DBG("cfg_access %d bus->number %u dev %u at %x *data %x conf %lx\n",
160             access_type, bus->number, device, where, *data, offset);
161
162         /* Check master abort */
163         status = au_readl(Au1500_PCI_STATCMD);
164
165         if (status & (1 << 29)) {
166                 *data = 0xffffffff;
167                 error = -1;
168                 DBG("Au1x Master Abort\n");
169         } else if ((status >> 28) & 0xf) {
170                 DBG("PCI ERR detected: device %u, status %lx\n",
171                     device, (status >> 28) & 0xf);
172
173                 /* Clear errors */
174                 au_writel(status & 0xf000ffff, Au1500_PCI_STATCMD);
175
176                 *data = 0xffffffff;
177                 error = -1;
178         }
179
180         /* Take away the IDSEL. */
181         if (board_pci_idsel)
182                 (void)board_pci_idsel(device, 0);
183
184         local_irq_restore(flags);
185         return error;
186 #endif
187 }
188
189 static int read_config_byte(struct pci_bus *bus, unsigned int devfn,
190                             int where,  u8 *val)
191 {
192         u32 data;
193         int ret;
194
195         ret = config_access(PCI_ACCESS_READ, bus, devfn, where, &data);
196         if (where & 1)
197                 data >>= 8;
198         if (where & 2)
199                 data >>= 16;
200         *val = data & 0xff;
201         return ret;
202 }
203
204 static int read_config_word(struct pci_bus *bus, unsigned int devfn,
205                             int where, u16 *val)
206 {
207         u32 data;
208         int ret;
209
210         ret = config_access(PCI_ACCESS_READ, bus, devfn, where, &data);
211         if (where & 2)
212                 data >>= 16;
213         *val = data & 0xffff;
214         return ret;
215 }
216
217 static int read_config_dword(struct pci_bus *bus, unsigned int devfn,
218                              int where, u32 *val)
219 {
220         int ret;
221
222         ret = config_access(PCI_ACCESS_READ, bus, devfn, where, val);
223         return ret;
224 }
225
226 static int write_config_byte(struct pci_bus *bus, unsigned int devfn,
227                              int where, u8 val)
228 {
229         u32 data = 0;
230
231         if (config_access(PCI_ACCESS_READ, bus, devfn, where, &data))
232                 return -1;
233
234         data = (data & ~(0xff << ((where & 3) << 3))) |
235                (val << ((where & 3) << 3));
236
237         if (config_access(PCI_ACCESS_WRITE, bus, devfn, where, &data))
238                 return -1;
239
240         return PCIBIOS_SUCCESSFUL;
241 }
242
243 static int write_config_word(struct pci_bus *bus, unsigned int devfn,
244                              int where, u16 val)
245 {
246         u32 data = 0;
247
248         if (config_access(PCI_ACCESS_READ, bus, devfn, where, &data))
249                 return -1;
250
251         data = (data & ~(0xffff << ((where & 3) << 3))) |
252                (val << ((where & 3) << 3));
253
254         if (config_access(PCI_ACCESS_WRITE, bus, devfn, where, &data))
255                 return -1;
256
257         return PCIBIOS_SUCCESSFUL;
258 }
259
260 static int write_config_dword(struct pci_bus *bus, unsigned int devfn,
261                               int where, u32 val)
262 {
263         if (config_access(PCI_ACCESS_WRITE, bus, devfn, where, &val))
264                 return -1;
265
266         return PCIBIOS_SUCCESSFUL;
267 }
268
269 static int config_read(struct pci_bus *bus, unsigned int devfn,
270                        int where, int size, u32 *val)
271 {
272         switch (size) {
273         case 1: {
274                         u8 _val;
275                         int rc = read_config_byte(bus, devfn, where, &_val);
276
277                         *val = _val;
278                         return rc;
279                 }
280         case 2: {
281                         u16 _val;
282                         int rc = read_config_word(bus, devfn, where, &_val);
283
284                         *val = _val;
285                         return rc;
286                 }
287         default:
288                 return read_config_dword(bus, devfn, where, val);
289         }
290 }
291
292 static int config_write(struct pci_bus *bus, unsigned int devfn,
293                         int where, int size, u32 val)
294 {
295         switch (size) {
296         case 1:
297                 return write_config_byte(bus, devfn, where, (u8) val);
298         case 2:
299                 return write_config_word(bus, devfn, where, (u16) val);
300         default:
301                 return write_config_dword(bus, devfn, where, val);
302         }
303 }
304
305 struct pci_ops au1x_pci_ops = {
306         config_read,
307         config_write
308 };