2 * drivers/pci/setup-res.c
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)
9 * Support routines for initializing a PCI subsystem.
12 /* fixed for multiple pci buses, 1999 Andrea Arcangeli <andrea@suse.de> */
15 * Nov 2000, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
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 <linux/config.h>
29 //#define DEBUG_CONFIG
31 # define DBGC(args) printk args
38 pci_update_resource(struct pci_dev
*dev
, struct resource
*res
, int resno
)
40 struct pci_bus_region region
;
44 pcibios_resource_to_bus(dev
, ®ion
, res
);
46 DBGC((KERN_ERR
" got res [%lx:%lx] bus [%lx:%lx] flags %lx for "
47 "BAR %d of %s\n", res
->start
, res
->end
,
48 region
.start
, region
.end
, res
->flags
,
49 resno
, pci_name(dev
)));
51 #ifdef CONFIG_ARCH_MOXACPU // add by Victor Yu. 01-10-2006
52 if ( res
->flags
& IORESOURCE_IO
)
53 new = PHY_ADDRESS(region
.start
) | (res
->flags
& PCI_REGION_FLAG_MASK
);
55 new = MEM_PHY_ADDRESS(region
.start
) | (res
->flags
& PCI_REGION_FLAG_MASK
);
57 new = region
.start
| (res
->flags
& PCI_REGION_FLAG_MASK
);
59 if (res
->flags
& IORESOURCE_IO
)
60 mask
= (u32
)PCI_BASE_ADDRESS_IO_MASK
;
62 mask
= (u32
)PCI_BASE_ADDRESS_MEM_MASK
;
65 reg
= PCI_BASE_ADDRESS_0
+ 4 * resno
;
66 } else if (resno
== PCI_ROM_RESOURCE
) {
67 new |= res
->flags
& PCI_ROM_ADDRESS_ENABLE
;
68 reg
= dev
->rom_base_reg
;
70 /* Hmm, non-standard resource. */
72 return; /* kill uninitialised var warning */
75 pci_write_config_dword(dev
, reg
, new);
76 pci_read_config_dword(dev
, reg
, &check
);
78 if ((new ^ check
) & mask
) {
79 printk(KERN_ERR
"PCI: Error while updating region "
80 "%s/%d (%08x != %08x)\n", pci_name(dev
), resno
,
84 if ((new & (PCI_BASE_ADDRESS_SPACE
|PCI_BASE_ADDRESS_MEM_TYPE_MASK
)) ==
85 (PCI_BASE_ADDRESS_SPACE_MEMORY
|PCI_BASE_ADDRESS_MEM_TYPE_64
)) {
86 new = 0; /* currently everyone zeros the high address */
87 pci_write_config_dword(dev
, reg
+ 4, new);
88 pci_read_config_dword(dev
, reg
+ 4, &check
);
90 printk(KERN_ERR
"PCI: Error updating region "
91 "%s/%d (high %08x != %08x)\n",
92 pci_name(dev
), resno
, new, check
);
95 res
->flags
&= ~IORESOURCE_UNSET
;
96 DBGC((KERN_INFO
"PCI: moved device %s resource %d (%lx) to %x\n",
97 dev
->slot_name
, resno
, res
->flags
,
98 new & ~PCI_REGION_FLAG_MASK
));
102 pci_claim_resource(struct pci_dev
*dev
, int resource
)
104 struct resource
*res
= &dev
->resource
[resource
];
105 struct resource
*root
= NULL
;
106 char *dtype
= resource
< PCI_BRIDGE_RESOURCES
? "device" : "bridge";
109 if (res
->flags
& IORESOURCE_IO
)
110 root
= &ioport_resource
;
111 if (res
->flags
& IORESOURCE_MEM
)
112 root
= &iomem_resource
;
116 err
= insert_resource(root
, res
);
119 printk(KERN_ERR
"PCI: %s region %d of %s %s [%lx:%lx]\n",
120 root
? "Address space collision on" :
121 "No parent found for",
122 resource
, dtype
, pci_name(dev
), res
->start
, res
->end
);
128 int pci_assign_resource(struct pci_dev
*dev
, int resno
)
130 struct pci_bus
*bus
= dev
->bus
;
131 struct resource
*res
= dev
->resource
+ resno
;
132 unsigned long size
, min
, align
;
135 size
= res
->end
- res
->start
+ 1;
136 min
= (res
->flags
& IORESOURCE_IO
) ? PCIBIOS_MIN_IO
: PCIBIOS_MIN_MEM
;
137 /* The bridge resources are special, as their
138 size != alignment. Sizing routines return
139 required alignment in the "start" field. */
140 align
= (resno
< PCI_BRIDGE_RESOURCES
) ? size
: res
->start
;
142 /* First, try exact prefetching match.. */
143 ret
= pci_bus_alloc_resource(bus
, res
, size
, align
, min
,
145 pcibios_align_resource
, dev
);
147 if (ret
< 0 && (res
->flags
& IORESOURCE_PREFETCH
)) {
151 * But a prefetching area can handle a non-prefetching
152 * window (it will just not perform as well).
154 ret
= pci_bus_alloc_resource(bus
, res
, size
, align
, min
, 0,
155 pcibios_align_resource
, dev
);
159 printk(KERN_ERR
"PCI: Failed to allocate %s resource #%d:%lx@%lx for %s\n",
160 res
->flags
& IORESOURCE_IO
? "I/O" : "mem",
161 resno
, size
, res
->start
, pci_name(dev
));
162 } else if (resno
< PCI_BRIDGE_RESOURCES
) {
163 pci_update_resource(dev
, res
, resno
);
169 /* Sort resources by alignment */
171 pdev_sort_resources(struct pci_dev
*dev
, struct resource_list
*head
)
175 for (i
= 0; i
< PCI_NUM_RESOURCES
; i
++) {
177 struct resource_list
*list
, *tmp
;
178 unsigned long r_align
;
180 r
= &dev
->resource
[i
];
181 r_align
= r
->end
- r
->start
;
183 if (!(r
->flags
) || r
->parent
)
186 printk(KERN_WARNING
"PCI: Ignore bogus resource %d "
188 i
, r
->start
, r
->end
, pci_name(dev
));
191 r_align
= (i
< PCI_BRIDGE_RESOURCES
) ? r_align
+ 1 : r
->start
;
192 for (list
= head
; ; list
= list
->next
) {
193 unsigned long align
= 0;
194 struct resource_list
*ln
= list
->next
;
198 idx
= ln
->res
- &ln
->dev
->resource
[0];
199 align
= (idx
< PCI_BRIDGE_RESOURCES
) ?
200 ln
->res
->end
- ln
->res
->start
+ 1 :
203 if (r_align
> align
) {
204 tmp
= kmalloc(sizeof(*tmp
), GFP_KERNEL
);
206 panic("pdev_sort_resources(): "
207 "kmalloc() failed!\n");