Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-2.6
[linux-2.6] / arch / x86 / pci / pcbios.c
1 /*
2  * BIOS32 and PCI BIOS handling.
3  */
4
5 #include <linux/pci.h>
6 #include <linux/init.h>
7 #include <linux/module.h>
8 #include <linux/uaccess.h>
9 #include "pci.h"
10 #include "pci-functions.h"
11
12
13 /* BIOS32 signature: "_32_" */
14 #define BIOS32_SIGNATURE        (('_' << 0) + ('3' << 8) + ('2' << 16) + ('_' << 24))
15
16 /* PCI signature: "PCI " */
17 #define PCI_SIGNATURE           (('P' << 0) + ('C' << 8) + ('I' << 16) + (' ' << 24))
18
19 /* PCI service signature: "$PCI" */
20 #define PCI_SERVICE             (('$' << 0) + ('P' << 8) + ('C' << 16) + ('I' << 24))
21
22 /* PCI BIOS hardware mechanism flags */
23 #define PCIBIOS_HW_TYPE1                0x01
24 #define PCIBIOS_HW_TYPE2                0x02
25 #define PCIBIOS_HW_TYPE1_SPEC           0x10
26 #define PCIBIOS_HW_TYPE2_SPEC           0x20
27
28 /*
29  * This is the standard structure used to identify the entry point
30  * to the BIOS32 Service Directory, as documented in
31  *      Standard BIOS 32-bit Service Directory Proposal
32  *      Revision 0.4 May 24, 1993
33  *      Phoenix Technologies Ltd.
34  *      Norwood, MA
35  * and the PCI BIOS specification.
36  */
37
38 union bios32 {
39         struct {
40                 unsigned long signature;        /* _32_ */
41                 unsigned long entry;            /* 32 bit physical address */
42                 unsigned char revision;         /* Revision level, 0 */
43                 unsigned char length;           /* Length in paragraphs should be 01 */
44                 unsigned char checksum;         /* All bytes must add up to zero */
45                 unsigned char reserved[5];      /* Must be zero */
46         } fields;
47         char chars[16];
48 };
49
50 /*
51  * Physical address of the service directory.  I don't know if we're
52  * allowed to have more than one of these or not, so just in case
53  * we'll make pcibios_present() take a memory start parameter and store
54  * the array there.
55  */
56
57 static struct {
58         unsigned long address;
59         unsigned short segment;
60 } bios32_indirect = { 0, __KERNEL_CS };
61
62 /*
63  * Returns the entry point for the given service, NULL on error
64  */
65
66 static unsigned long bios32_service(unsigned long service)
67 {
68         unsigned char return_code;      /* %al */
69         unsigned long address;          /* %ebx */
70         unsigned long length;           /* %ecx */
71         unsigned long entry;            /* %edx */
72         unsigned long flags;
73
74         local_irq_save(flags);
75         __asm__("lcall *(%%edi); cld"
76                 : "=a" (return_code),
77                   "=b" (address),
78                   "=c" (length),
79                   "=d" (entry)
80                 : "0" (service),
81                   "1" (0),
82                   "D" (&bios32_indirect));
83         local_irq_restore(flags);
84
85         switch (return_code) {
86                 case 0:
87                         return address + entry;
88                 case 0x80:      /* Not present */
89                         printk(KERN_WARNING "bios32_service(0x%lx): not present\n", service);
90                         return 0;
91                 default: /* Shouldn't happen */
92                         printk(KERN_WARNING "bios32_service(0x%lx): returned 0x%x -- BIOS bug!\n",
93                                 service, return_code);
94                         return 0;
95         }
96 }
97
98 static struct {
99         unsigned long address;
100         unsigned short segment;
101 } pci_indirect = { 0, __KERNEL_CS };
102
103 static int pci_bios_present;
104
105 static int __devinit check_pcibios(void)
106 {
107         u32 signature, eax, ebx, ecx;
108         u8 status, major_ver, minor_ver, hw_mech;
109         unsigned long flags, pcibios_entry;
110
111         if ((pcibios_entry = bios32_service(PCI_SERVICE))) {
112                 pci_indirect.address = pcibios_entry + PAGE_OFFSET;
113
114                 local_irq_save(flags);
115                 __asm__(
116                         "lcall *(%%edi); cld\n\t"
117                         "jc 1f\n\t"
118                         "xor %%ah, %%ah\n"
119                         "1:"
120                         : "=d" (signature),
121                           "=a" (eax),
122                           "=b" (ebx),
123                           "=c" (ecx)
124                         : "1" (PCIBIOS_PCI_BIOS_PRESENT),
125                           "D" (&pci_indirect)
126                         : "memory");
127                 local_irq_restore(flags);
128
129                 status = (eax >> 8) & 0xff;
130                 hw_mech = eax & 0xff;
131                 major_ver = (ebx >> 8) & 0xff;
132                 minor_ver = ebx & 0xff;
133                 if (pcibios_last_bus < 0)
134                         pcibios_last_bus = ecx & 0xff;
135                 DBG("PCI: BIOS probe returned s=%02x hw=%02x ver=%02x.%02x l=%02x\n",
136                         status, hw_mech, major_ver, minor_ver, pcibios_last_bus);
137                 if (status || signature != PCI_SIGNATURE) {
138                         printk (KERN_ERR "PCI: BIOS BUG #%x[%08x] found\n",
139                                 status, signature);
140                         return 0;
141                 }
142                 printk(KERN_INFO "PCI: PCI BIOS revision %x.%02x entry at 0x%lx, last bus=%d\n",
143                         major_ver, minor_ver, pcibios_entry, pcibios_last_bus);
144 #ifdef CONFIG_PCI_DIRECT
145                 if (!(hw_mech & PCIBIOS_HW_TYPE1))
146                         pci_probe &= ~PCI_PROBE_CONF1;
147                 if (!(hw_mech & PCIBIOS_HW_TYPE2))
148                         pci_probe &= ~PCI_PROBE_CONF2;
149 #endif
150                 return 1;
151         }
152         return 0;
153 }
154
155 static int __devinit pci_bios_find_device (unsigned short vendor, unsigned short device_id,
156                                         unsigned short index, unsigned char *bus, unsigned char *device_fn)
157 {
158         unsigned short bx;
159         unsigned short ret;
160
161         __asm__("lcall *(%%edi); cld\n\t"
162                 "jc 1f\n\t"
163                 "xor %%ah, %%ah\n"
164                 "1:"
165                 : "=b" (bx),
166                   "=a" (ret)
167                 : "1" (PCIBIOS_FIND_PCI_DEVICE),
168                   "c" (device_id),
169                   "d" (vendor),
170                   "S" ((int) index),
171                   "D" (&pci_indirect));
172         *bus = (bx >> 8) & 0xff;
173         *device_fn = bx & 0xff;
174         return (int) (ret & 0xff00) >> 8;
175 }
176
177 static int pci_bios_read(unsigned int seg, unsigned int bus,
178                          unsigned int devfn, int reg, int len, u32 *value)
179 {
180         unsigned long result = 0;
181         unsigned long flags;
182         unsigned long bx = (bus << 8) | devfn;
183
184         if (!value || (bus > 255) || (devfn > 255) || (reg > 255))
185                 return -EINVAL;
186
187         spin_lock_irqsave(&pci_config_lock, flags);
188
189         switch (len) {
190         case 1:
191                 __asm__("lcall *(%%esi); cld\n\t"
192                         "jc 1f\n\t"
193                         "xor %%ah, %%ah\n"
194                         "1:"
195                         : "=c" (*value),
196                           "=a" (result)
197                         : "1" (PCIBIOS_READ_CONFIG_BYTE),
198                           "b" (bx),
199                           "D" ((long)reg),
200                           "S" (&pci_indirect));
201                 break;
202         case 2:
203                 __asm__("lcall *(%%esi); cld\n\t"
204                         "jc 1f\n\t"
205                         "xor %%ah, %%ah\n"
206                         "1:"
207                         : "=c" (*value),
208                           "=a" (result)
209                         : "1" (PCIBIOS_READ_CONFIG_WORD),
210                           "b" (bx),
211                           "D" ((long)reg),
212                           "S" (&pci_indirect));
213                 break;
214         case 4:
215                 __asm__("lcall *(%%esi); cld\n\t"
216                         "jc 1f\n\t"
217                         "xor %%ah, %%ah\n"
218                         "1:"
219                         : "=c" (*value),
220                           "=a" (result)
221                         : "1" (PCIBIOS_READ_CONFIG_DWORD),
222                           "b" (bx),
223                           "D" ((long)reg),
224                           "S" (&pci_indirect));
225                 break;
226         }
227
228         spin_unlock_irqrestore(&pci_config_lock, flags);
229
230         return (int)((result & 0xff00) >> 8);
231 }
232
233 static int pci_bios_write(unsigned int seg, unsigned int bus,
234                           unsigned int devfn, int reg, int len, u32 value)
235 {
236         unsigned long result = 0;
237         unsigned long flags;
238         unsigned long bx = (bus << 8) | devfn;
239
240         if ((bus > 255) || (devfn > 255) || (reg > 255)) 
241                 return -EINVAL;
242
243         spin_lock_irqsave(&pci_config_lock, flags);
244
245         switch (len) {
246         case 1:
247                 __asm__("lcall *(%%esi); cld\n\t"
248                         "jc 1f\n\t"
249                         "xor %%ah, %%ah\n"
250                         "1:"
251                         : "=a" (result)
252                         : "0" (PCIBIOS_WRITE_CONFIG_BYTE),
253                           "c" (value),
254                           "b" (bx),
255                           "D" ((long)reg),
256                           "S" (&pci_indirect));
257                 break;
258         case 2:
259                 __asm__("lcall *(%%esi); cld\n\t"
260                         "jc 1f\n\t"
261                         "xor %%ah, %%ah\n"
262                         "1:"
263                         : "=a" (result)
264                         : "0" (PCIBIOS_WRITE_CONFIG_WORD),
265                           "c" (value),
266                           "b" (bx),
267                           "D" ((long)reg),
268                           "S" (&pci_indirect));
269                 break;
270         case 4:
271                 __asm__("lcall *(%%esi); cld\n\t"
272                         "jc 1f\n\t"
273                         "xor %%ah, %%ah\n"
274                         "1:"
275                         : "=a" (result)
276                         : "0" (PCIBIOS_WRITE_CONFIG_DWORD),
277                           "c" (value),
278                           "b" (bx),
279                           "D" ((long)reg),
280                           "S" (&pci_indirect));
281                 break;
282         }
283
284         spin_unlock_irqrestore(&pci_config_lock, flags);
285
286         return (int)((result & 0xff00) >> 8);
287 }
288
289
290 /*
291  * Function table for BIOS32 access
292  */
293
294 static struct pci_raw_ops pci_bios_access = {
295         .read =         pci_bios_read,
296         .write =        pci_bios_write
297 };
298
299 /*
300  * Try to find PCI BIOS.
301  */
302
303 static struct pci_raw_ops * __devinit pci_find_bios(void)
304 {
305         union bios32 *check;
306         unsigned char sum;
307         int i, length;
308
309         /*
310          * Follow the standard procedure for locating the BIOS32 Service
311          * directory by scanning the permissible address range from
312          * 0xe0000 through 0xfffff for a valid BIOS32 structure.
313          */
314
315         for (check = (union bios32 *) __va(0xe0000);
316              check <= (union bios32 *) __va(0xffff0);
317              ++check) {
318                 long sig;
319                 if (probe_kernel_address(&check->fields.signature, sig))
320                         continue;
321
322                 if (check->fields.signature != BIOS32_SIGNATURE)
323                         continue;
324                 length = check->fields.length * 16;
325                 if (!length)
326                         continue;
327                 sum = 0;
328                 for (i = 0; i < length ; ++i)
329                         sum += check->chars[i];
330                 if (sum != 0)
331                         continue;
332                 if (check->fields.revision != 0) {
333                         printk("PCI: unsupported BIOS32 revision %d at 0x%p\n",
334                                 check->fields.revision, check);
335                         continue;
336                 }
337                 DBG("PCI: BIOS32 Service Directory structure at 0x%p\n", check);
338                 if (check->fields.entry >= 0x100000) {
339                         printk("PCI: BIOS32 entry (0x%p) in high memory, "
340                                         "cannot use.\n", check);
341                         return NULL;
342                 } else {
343                         unsigned long bios32_entry = check->fields.entry;
344                         DBG("PCI: BIOS32 Service Directory entry at 0x%lx\n",
345                                         bios32_entry);
346                         bios32_indirect.address = bios32_entry + PAGE_OFFSET;
347                         if (check_pcibios())
348                                 return &pci_bios_access;
349                 }
350                 break;  /* Hopefully more than one BIOS32 cannot happen... */
351         }
352
353         return NULL;
354 }
355
356 /*
357  * Sort the device list according to PCI BIOS. Nasty hack, but since some
358  * fool forgot to define the `correct' device order in the PCI BIOS specs
359  * and we want to be (possibly bug-to-bug ;-]) compatible with older kernels
360  * which used BIOS ordering, we are bound to do this...
361  */
362
363 void __devinit pcibios_sort(void)
364 {
365         LIST_HEAD(sorted_devices);
366         struct list_head *ln;
367         struct pci_dev *dev, *d;
368         int idx, found;
369         unsigned char bus, devfn;
370
371         DBG("PCI: Sorting device list...\n");
372         while (!list_empty(&pci_devices)) {
373                 ln = pci_devices.next;
374                 dev = pci_dev_g(ln);
375                 idx = found = 0;
376                 while (pci_bios_find_device(dev->vendor, dev->device, idx, &bus, &devfn) == PCIBIOS_SUCCESSFUL) {
377                         idx++;
378                         list_for_each(ln, &pci_devices) {
379                                 d = pci_dev_g(ln);
380                                 if (d->bus->number == bus && d->devfn == devfn) {
381                                         list_move_tail(&d->global_list, &sorted_devices);
382                                         if (d == dev)
383                                                 found = 1;
384                                         break;
385                                 }
386                         }
387                         if (ln == &pci_devices) {
388                                 printk(KERN_WARNING "PCI: BIOS reporting unknown device %02x:%02x\n", bus, devfn);
389                                 /*
390                                  * We must not continue scanning as several buggy BIOSes
391                                  * return garbage after the last device. Grr.
392                                  */
393                                 break;
394                         }
395                 }
396                 if (!found) {
397                         printk(KERN_WARNING "PCI: Device %s not found by BIOS\n",
398                                 pci_name(dev));
399                         list_move_tail(&dev->global_list, &sorted_devices);
400                 }
401         }
402         list_splice(&sorted_devices, &pci_devices);
403 }
404
405 /*
406  *  BIOS Functions for IRQ Routing
407  */
408
409 struct irq_routing_options {
410         u16 size;
411         struct irq_info *table;
412         u16 segment;
413 } __attribute__((packed));
414
415 struct irq_routing_table * pcibios_get_irq_routing_table(void)
416 {
417         struct irq_routing_options opt;
418         struct irq_routing_table *rt = NULL;
419         int ret, map;
420         unsigned long page;
421
422         if (!pci_bios_present)
423                 return NULL;
424         page = __get_free_page(GFP_KERNEL);
425         if (!page)
426                 return NULL;
427         opt.table = (struct irq_info *) page;
428         opt.size = PAGE_SIZE;
429         opt.segment = __KERNEL_DS;
430
431         DBG("PCI: Fetching IRQ routing table... ");
432         __asm__("push %%es\n\t"
433                 "push %%ds\n\t"
434                 "pop  %%es\n\t"
435                 "lcall *(%%esi); cld\n\t"
436                 "pop %%es\n\t"
437                 "jc 1f\n\t"
438                 "xor %%ah, %%ah\n"
439                 "1:"
440                 : "=a" (ret),
441                   "=b" (map),
442                   "=m" (opt)
443                 : "0" (PCIBIOS_GET_ROUTING_OPTIONS),
444                   "1" (0),
445                   "D" ((long) &opt),
446                   "S" (&pci_indirect),
447                   "m" (opt)
448                 : "memory");
449         DBG("OK  ret=%d, size=%d, map=%x\n", ret, opt.size, map);
450         if (ret & 0xff00)
451                 printk(KERN_ERR "PCI: Error %02x when fetching IRQ routing table.\n", (ret >> 8) & 0xff);
452         else if (opt.size) {
453                 rt = kmalloc(sizeof(struct irq_routing_table) + opt.size, GFP_KERNEL);
454                 if (rt) {
455                         memset(rt, 0, sizeof(struct irq_routing_table));
456                         rt->size = opt.size + sizeof(struct irq_routing_table);
457                         rt->exclusive_irqs = map;
458                         memcpy(rt->slots, (void *) page, opt.size);
459                         printk(KERN_INFO "PCI: Using BIOS Interrupt Routing Table\n");
460                 }
461         }
462         free_page(page);
463         return rt;
464 }
465 EXPORT_SYMBOL(pcibios_get_irq_routing_table);
466
467 int pcibios_set_irq_routing(struct pci_dev *dev, int pin, int irq)
468 {
469         int ret;
470
471         __asm__("lcall *(%%esi); cld\n\t"
472                 "jc 1f\n\t"
473                 "xor %%ah, %%ah\n"
474                 "1:"
475                 : "=a" (ret)
476                 : "0" (PCIBIOS_SET_PCI_HW_INT),
477                   "b" ((dev->bus->number << 8) | dev->devfn),
478                   "c" ((irq << 8) | (pin + 10)),
479                   "S" (&pci_indirect));
480         return !(ret & 0xff00);
481 }
482 EXPORT_SYMBOL(pcibios_set_irq_routing);
483
484 void __init pci_pcbios_init(void)
485 {
486         if ((pci_probe & PCI_PROBE_BIOS) 
487                 && ((raw_pci_ops = pci_find_bios()))) {
488                 pci_probe |= PCI_BIOS_SORT;
489                 pci_bios_present = 1;
490         }
491 }
492