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