?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[wrt350n-kernel.git] / arch / x86 / pci / pcbios.c
blob92274a634b7b064750a3d89c544a9325afcf90af
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 <<<<<<< HEAD:arch/x86/pci/pcbios.c
202 =======
203 /*
204 * Zero-extend the result beyond 8 bits, do not trust the
205 * BIOS having done it:
206 */
207 *value &= 0xff;
208 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a:arch/x86/pci/pcbios.c
209 break;
210 case 2:
211 __asm__("lcall *(%%esi); cld\n\t"
212 "jc 1f\n\t"
213 "xor %%ah, %%ah\n"
214 "1:"
215 : "=c" (*value),
216 "=a" (result)
217 : "1" (PCIBIOS_READ_CONFIG_WORD),
218 "b" (bx),
219 "D" ((long)reg),
220 "S" (&pci_indirect));
221 <<<<<<< HEAD:arch/x86/pci/pcbios.c
222 =======
223 /*
224 * Zero-extend the result beyond 16 bits, do not trust the
225 * BIOS having done it:
226 */
227 *value &= 0xffff;
228 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a:arch/x86/pci/pcbios.c
229 break;
230 case 4:
231 __asm__("lcall *(%%esi); cld\n\t"
232 "jc 1f\n\t"
233 "xor %%ah, %%ah\n"
234 "1:"
235 : "=c" (*value),
236 "=a" (result)
237 : "1" (PCIBIOS_READ_CONFIG_DWORD),
238 "b" (bx),
239 "D" ((long)reg),
240 "S" (&pci_indirect));
241 break;
242 }
243
244 spin_unlock_irqrestore(&pci_config_lock, flags);
245
246 return (int)((result & 0xff00) >> 8);
247 }
248
249 static int pci_bios_write(unsigned int seg, unsigned int bus,
250 unsigned int devfn, int reg, int len, u32 value)
251 {
252 unsigned long result = 0;
253 unsigned long flags;
254 unsigned long bx = (bus << 8) | devfn;
255
256 if ((bus > 255) || (devfn > 255) || (reg > 255))
257 return -EINVAL;
258
259 spin_lock_irqsave(&pci_config_lock, flags);
260
261 switch (len) {
262 case 1:
263 __asm__("lcall *(%%esi); cld\n\t"
264 "jc 1f\n\t"
265 "xor %%ah, %%ah\n"
266 "1:"
267 : "=a" (result)
268 : "0" (PCIBIOS_WRITE_CONFIG_BYTE),
269 "c" (value),
270 "b" (bx),
271 "D" ((long)reg),
272 "S" (&pci_indirect));
273 break;
274 case 2:
275 __asm__("lcall *(%%esi); cld\n\t"
276 "jc 1f\n\t"
277 "xor %%ah, %%ah\n"
278 "1:"
279 : "=a" (result)
280 : "0" (PCIBIOS_WRITE_CONFIG_WORD),
281 "c" (value),
282 "b" (bx),
283 "D" ((long)reg),
284 "S" (&pci_indirect));
285 break;
286 case 4:
287 __asm__("lcall *(%%esi); cld\n\t"
288 "jc 1f\n\t"
289 "xor %%ah, %%ah\n"
290 "1:"
291 : "=a" (result)
292 : "0" (PCIBIOS_WRITE_CONFIG_DWORD),
293 "c" (value),
294 "b" (bx),
295 "D" ((long)reg),
296 "S" (&pci_indirect));
297 break;
298 }
299
300 spin_unlock_irqrestore(&pci_config_lock, flags);
301
302 return (int)((result & 0xff00) >> 8);
303 }
304
305
306 /*
307 * Function table for BIOS32 access
308 */
309
310 static struct pci_raw_ops pci_bios_access = {
311 .read = pci_bios_read,
312 .write = pci_bios_write
313 };
314
315 /*
316 * Try to find PCI BIOS.
317 */
318
319 static struct pci_raw_ops * __devinit pci_find_bios(void)
320 {
321 union bios32 *check;
322 unsigned char sum;
323 int i, length;
324
325 /*
326 * Follow the standard procedure for locating the BIOS32 Service
327 * directory by scanning the permissible address range from
328 * 0xe0000 through 0xfffff for a valid BIOS32 structure.
329 */
330
331 for (check = (union bios32 *) __va(0xe0000);
332 check <= (union bios32 *) __va(0xffff0);
333 ++check) {
334 long sig;
335 if (probe_kernel_address(&check->fields.signature, sig))
336 continue;
337
338 if (check->fields.signature != BIOS32_SIGNATURE)
339 continue;
340 length = check->fields.length * 16;
341 if (!length)
342 continue;
343 sum = 0;
344 for (i = 0; i < length ; ++i)
345 sum += check->chars[i];
346 if (sum != 0)
347 continue;
348 if (check->fields.revision != 0) {
349 printk("PCI: unsupported BIOS32 revision %d at 0x%p\n",
350 check->fields.revision, check);
351 continue;
352 }
353 DBG("PCI: BIOS32 Service Directory structure at 0x%p\n", check);
354 if (check->fields.entry >= 0x100000) {
355 printk("PCI: BIOS32 entry (0x%p) in high memory, "
356 "cannot use.\n", check);
357 return NULL;
358 } else {
359 unsigned long bios32_entry = check->fields.entry;
360 DBG("PCI: BIOS32 Service Directory entry at 0x%lx\n",
361 bios32_entry);
362 bios32_indirect.address = bios32_entry + PAGE_OFFSET;
363 if (check_pcibios())
364 return &pci_bios_access;
365 }
366 break; /* Hopefully more than one BIOS32 cannot happen... */
367 }
368
369 return NULL;
370 }
371
372 /*
373 * Sort the device list according to PCI BIOS. Nasty hack, but since some
374 * fool forgot to define the `correct' device order in the PCI BIOS specs
375 * and we want to be (possibly bug-to-bug ;-]) compatible with older kernels
376 * which used BIOS ordering, we are bound to do this...
377 */
378
379 void __devinit pcibios_sort(void)
380 {
381 LIST_HEAD(sorted_devices);
382 struct list_head *ln;
383 struct pci_dev *dev, *d;
384 int idx, found;
385 unsigned char bus, devfn;
386
387 DBG("PCI: Sorting device list...\n");
388 while (!list_empty(&pci_devices)) {
389 ln = pci_devices.next;
390 dev = pci_dev_g(ln);
391 idx = found = 0;
392 while (pci_bios_find_device(dev->vendor, dev->device, idx, &bus, &devfn) == PCIBIOS_SUCCESSFUL) {
393 idx++;
394 list_for_each(ln, &pci_devices) {
395 d = pci_dev_g(ln);
396 if (d->bus->number == bus && d->devfn == devfn) {
397 list_move_tail(&d->global_list, &sorted_devices);
398 if (d == dev)
399 found = 1;
400 break;
401 }
402 }
403 if (ln == &pci_devices) {
404 printk(KERN_WARNING "PCI: BIOS reporting unknown device %02x:%02x\n", bus, devfn);
405 /*
406 * We must not continue scanning as several buggy BIOSes
407 * return garbage after the last device. Grr.
408 */
409 break;
410 }
411 }
412 if (!found) {
413 printk(KERN_WARNING "PCI: Device %s not found by BIOS\n",
414 pci_name(dev));
415 list_move_tail(&dev->global_list, &sorted_devices);
416 }
417 }
418 list_splice(&sorted_devices, &pci_devices);
419 }
420
421 /*
422 * BIOS Functions for IRQ Routing
423 */
424
425 struct irq_routing_options {
426 u16 size;
427 struct irq_info *table;
428 u16 segment;
429 } __attribute__((packed));
430
431 struct irq_routing_table * pcibios_get_irq_routing_table(void)
432 {
433 struct irq_routing_options opt;
434 struct irq_routing_table *rt = NULL;
435 int ret, map;
436 unsigned long page;
437
438 if (!pci_bios_present)
439 return NULL;
440 page = __get_free_page(GFP_KERNEL);
441 if (!page)
442 return NULL;
443 opt.table = (struct irq_info *) page;
444 opt.size = PAGE_SIZE;
445 opt.segment = __KERNEL_DS;
446
447 DBG("PCI: Fetching IRQ routing table... ");
448 __asm__("push %%es\n\t"
449 "push %%ds\n\t"
450 "pop %%es\n\t"
451 "lcall *(%%esi); cld\n\t"
452 "pop %%es\n\t"
453 "jc 1f\n\t"
454 "xor %%ah, %%ah\n"
455 "1:"
456 : "=a" (ret),
457 "=b" (map),
458 "=m" (opt)
459 : "0" (PCIBIOS_GET_ROUTING_OPTIONS),
460 "1" (0),
461 "D" ((long) &opt),
462 "S" (&pci_indirect),
463 "m" (opt)
464 : "memory");
465 DBG("OK ret=%d, size=%d, map=%x\n", ret, opt.size, map);
466 if (ret & 0xff00)
467 printk(KERN_ERR "PCI: Error %02x when fetching IRQ routing table.\n", (ret >> 8) & 0xff);
468 else if (opt.size) {
469 rt = kmalloc(sizeof(struct irq_routing_table) + opt.size, GFP_KERNEL);
470 if (rt) {
471 memset(rt, 0, sizeof(struct irq_routing_table));
472 rt->size = opt.size + sizeof(struct irq_routing_table);
473 rt->exclusive_irqs = map;
474 memcpy(rt->slots, (void *) page, opt.size);
475 printk(KERN_INFO "PCI: Using BIOS Interrupt Routing Table\n");
476 }
477 }
478 free_page(page);
479 return rt;
480 }
481 EXPORT_SYMBOL(pcibios_get_irq_routing_table);
482
483 int pcibios_set_irq_routing(struct pci_dev *dev, int pin, int irq)
484 {
485 int ret;
486
487 __asm__("lcall *(%%esi); cld\n\t"
488 "jc 1f\n\t"
489 "xor %%ah, %%ah\n"
490 "1:"
491 : "=a" (ret)
492 : "0" (PCIBIOS_SET_PCI_HW_INT),
493 "b" ((dev->bus->number << 8) | dev->devfn),
494 "c" ((irq << 8) | (pin + 10)),
495 "S" (&pci_indirect));
496 return !(ret & 0xff00);
497 }
498 EXPORT_SYMBOL(pcibios_set_irq_routing);
499
500 void __init pci_pcbios_init(void)
501 {
502 if ((pci_probe & PCI_PROBE_BIOS)
503 && ((raw_pci_ops = pci_find_bios()))) {
504 pci_probe |= PCI_BIOS_SORT;
505 pci_bios_present = 1;
506 }
507 }
508
WRT350N Kernel Patches