WebSVN - shark - Blame - Rev 428 - /shark/trunk/drivers/newpci/setup-res.c

Rev	Author	Line No.	Line
428	giacomo	1	/*
		2	* drivers/pci/setup-res.c
		3	*
		4	* Extruded from code written by
		5	* Dave Rusling (david.rusling@reo.mts.dec.com)
		6	* David Mosberger (davidm@cs.arizona.edu)
		7	* David Miller (davem@redhat.com)
		8	*
		9	* Support routines for initializing a PCI subsystem.
		10	*/
		11
		12	/* fixed for multiple pci buses, 1999 Andrea Arcangeli <andrea@suse.de> */
		13
		14	/*
		15	* Nov 2000, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
		16	* Resource sorting
		17	*/
		18
		19	#include <linux/init.h>
		20	#include <linux/kernel.h>
		21	#include <linux/pci.h>
		22	#include <linux/errno.h>
		23	#include <linux/ioport.h>
		24	#include <linux/cache.h>
		25	#include <linux/slab.h>
		26	#include "pci.h"
		27
		28	#define DEBUG_CONFIG 0
		29	#if DEBUG_CONFIG
		30	# define DBGC(args) printk args
		31	#else
		32	# define DBGC(args)
		33	#endif
		34
		35
		36	static void
		37	pci_update_resource(struct pci_dev dev, struct resource res, int resno)
		38	{
		39	struct pci_bus_region region;
		40	u32 new, check, mask;
		41	int reg;
		42
		43	pcibios_resource_to_bus(dev, &region, res);
		44
		45	DBGC((KERN_ERR " got res [%lx:%lx] bus [%lx:%lx] flags %lx for "
		46	"BAR %d of %s\n", res->start, res->end,
		47	region.start, region.end, res->flags,
		48	resno, pci_name(dev)));
		49
		50	new = region.start \| (res->flags & PCI_REGION_FLAG_MASK);
		51	if (res->flags & IORESOURCE_IO)
		52	mask = (u32)PCI_BASE_ADDRESS_IO_MASK;
		53	else
		54	mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
		55
		56	if (resno < 6) {
		57	reg = PCI_BASE_ADDRESS_0 + 4 * resno;
		58	} else if (resno == PCI_ROM_RESOURCE) {
		59	new \|= res->flags & PCI_ROM_ADDRESS_ENABLE;
		60	reg = dev->rom_base_reg;
		61	} else {
		62	/* Hmm, non-standard resource. */
		63	BUG();
		64	return; /* kill uninitialised var warning */
		65	}
		66
		67	pci_write_config_dword(dev, reg, new);
		68	pci_read_config_dword(dev, reg, &check);
		69
		70	if ((new ^ check) & mask) {
		71	printk(KERN_ERR "PCI: Error while updating region "
		72	"%s/%d (%08x != %08x)\n", pci_name(dev), resno,
		73	new, check);
		74	}
		75
		76	if ((new & (PCI_BASE_ADDRESS_SPACE\|PCI_BASE_ADDRESS_MEM_TYPE_MASK)) ==
		77	(PCI_BASE_ADDRESS_SPACE_MEMORY\|PCI_BASE_ADDRESS_MEM_TYPE_64)) {
		78	new = 0; /* currently everyone zeros the high address */
		79	pci_write_config_dword(dev, reg + 4, new);
		80	pci_read_config_dword(dev, reg + 4, &check);
		81	if (check != new) {
		82	printk(KERN_ERR "PCI: Error updating region "
		83	"%s/%d (high %08x != %08x)\n",
		84	pci_name(dev), resno, new, check);
		85	}
		86	}
		87	}
		88
		89	int __init
		90	pci_claim_resource(struct pci_dev *dev, int resource)
		91	{
		92	struct resource *res = &dev->resource[resource];
		93	struct resource *root = pci_find_parent_resource(dev, res);
		94	char *dtype = resource < PCI_BRIDGE_RESOURCES ? "device" : "bridge";
		95	int err;
		96
		97	err = -EINVAL;
		98	if (root != NULL)
		99	err = request_resource(root, res);
		100
		101	if (err) {
		102	printk(KERN_ERR "PCI: %s region %d of %s %s [%lx:%lx]\n",
		103	root ? "Address space collision on" :
		104	"No parent found for",
		105	resource, dtype, pci_name(dev), res->start, res->end);
		106	}
		107
		108	return err;
		109	}
		110
		111	int pci_assign_resource(struct pci_dev *dev, int resno)
		112	{
		113	struct pci_bus *bus = dev->bus;
		114	struct resource *res = dev->resource + resno;
		115	unsigned long size, min, align;
		116	int ret;
		117
		118	size = res->end - res->start + 1;
		119	min = (res->flags & IORESOURCE_IO) ? PCIBIOS_MIN_IO : PCIBIOS_MIN_MEM;
		120	/* The bridge resources are special, as their
		121	size != alignment. Sizing routines return
		122	required alignment in the "start" field. */
		123	align = (resno < PCI_BRIDGE_RESOURCES) ? size : res->start;
		124
		125	/* First, try exact prefetching match.. */
		126	ret = pci_bus_alloc_resource(bus, res, size, align, min,
		127	IORESOURCE_PREFETCH,
		128	pcibios_align_resource, dev);
		129
		130	if (ret < 0 && (res->flags & IORESOURCE_PREFETCH)) {
		131	/*
		132	* That failed.
		133	*
		134	* But a prefetching area can handle a non-prefetching
		135	* window (it will just not perform as well).
		136	*/
		137	ret = pci_bus_alloc_resource(bus, res, size, align, min, 0,
		138	pcibios_align_resource, dev);
		139	}
		140
		141	if (ret) {
		142	printk(KERN_ERR "PCI: Failed to allocate resource %d(%lx-%lx) for %s\n",
		143	resno, res->start, res->end, pci_name(dev));
		144	} else if (resno < PCI_BRIDGE_RESOURCES) {
		145	pci_update_resource(dev, res, resno);
		146	}
		147
		148	return ret;
		149	}
		150
		151	/* Sort resources by alignment */
		152	void __devinit
		153	pdev_sort_resources(struct pci_dev dev, struct resource_list head)
		154	{
		155	int i;
		156
		157	for (i = 0; i < PCI_NUM_RESOURCES; i++) {
		158	struct resource *r;
		159	struct resource_list list, tmp;
		160	unsigned long r_align;
		161
		162	r = &dev->resource[i];
		163	r_align = r->end - r->start;
		164
		165	if (!(r->flags) \|\| r->parent)
		166	continue;
		167	if (!r_align) {
		168	printk(KERN_WARNING "PCI: Ignore bogus resource %d "
		169	"[%lx:%lx] of %s\n",
		170	i, r->start, r->end, pci_name(dev));
		171	continue;
		172	}
		173	r_align = (i < PCI_BRIDGE_RESOURCES) ? r_align + 1 : r->start;
		174	for (list = head; ; list = list->next) {
		175	unsigned long align = 0;
		176	struct resource_list *ln = list->next;
		177	int idx;
		178
		179	if (ln) {
		180	idx = ln->res - &ln->dev->resource[0];
		181	align = (idx < PCI_BRIDGE_RESOURCES) ?
		182	ln->res->end - ln->res->start + 1 :
		183	ln->res->start;
		184	}
		185	if (r_align > align) {
		186	tmp = kmalloc(sizeof(*tmp), GFP_KERNEL);
		187	if (!tmp)
		188	panic("pdev_sort_resources(): "
		189	"kmalloc() failed!\n");
		190	tmp->next = ln;
		191	tmp->res = r;
		192	tmp->dev = dev;
		193	list->next = tmp;
		194	break;
		195	}
		196	}
		197	}
		198	}

Subversion Repositories shark

(root)/shark/trunk/drivers/newpci/setup-res.c @ 430 - Rev 428