Linux Audio

Check our new training course

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