of/pci: Use of_pci_range_parser
This patch converts the pci_load_of_ranges function to use the new common of_pci_range_parser. Signed-off-by: Andrew Murray <amurray@embedded-bits.co.uk> Signed-off-by: Andrew Murray <Andrew.Murray@arm.com> Signed-off-by: Liviu Dudau <Liviu.Dudau@arm.com> Signed-off-by: Michal Simek <michal.simek@xilinx.com>
This commit is contained in:
parent
6e4664525b
commit
4f7b6de437
1 changed files with 38 additions and 68 deletions
|
@ -657,67 +657,42 @@ void pci_resource_to_user(const struct pci_dev *dev, int bar,
|
||||||
void pci_process_bridge_OF_ranges(struct pci_controller *hose,
|
void pci_process_bridge_OF_ranges(struct pci_controller *hose,
|
||||||
struct device_node *dev, int primary)
|
struct device_node *dev, int primary)
|
||||||
{
|
{
|
||||||
const u32 *ranges;
|
|
||||||
int rlen;
|
|
||||||
int pna = of_n_addr_cells(dev);
|
|
||||||
int np = pna + 5;
|
|
||||||
int memno = 0, isa_hole = -1;
|
int memno = 0, isa_hole = -1;
|
||||||
u32 pci_space;
|
|
||||||
unsigned long long pci_addr, cpu_addr, pci_next, cpu_next, size;
|
|
||||||
unsigned long long isa_mb = 0;
|
unsigned long long isa_mb = 0;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
struct of_pci_range range;
|
||||||
|
struct of_pci_range_parser parser;
|
||||||
|
|
||||||
pr_info("PCI host bridge %s %s ranges:\n",
|
pr_info("PCI host bridge %s %s ranges:\n",
|
||||||
dev->full_name, primary ? "(primary)" : "");
|
dev->full_name, primary ? "(primary)" : "");
|
||||||
|
|
||||||
/* Get ranges property */
|
/* Check for ranges property */
|
||||||
ranges = of_get_property(dev, "ranges", &rlen);
|
if (of_pci_range_parser_init(&parser, dev))
|
||||||
if (ranges == NULL)
|
|
||||||
return;
|
return;
|
||||||
|
|
||||||
/* Parse it */
|
|
||||||
pr_debug("Parsing ranges property...\n");
|
pr_debug("Parsing ranges property...\n");
|
||||||
while ((rlen -= np * 4) >= 0) {
|
for_each_of_pci_range(&parser, &range) {
|
||||||
/* Read next ranges element */
|
/* Read next ranges element */
|
||||||
pci_space = ranges[0];
|
|
||||||
pci_addr = of_read_number(ranges + 1, 2);
|
|
||||||
cpu_addr = of_translate_address(dev, ranges + 3);
|
|
||||||
size = of_read_number(ranges + pna + 3, 2);
|
|
||||||
|
|
||||||
pr_debug("pci_space: 0x%08x pci_addr:0x%016llx ",
|
pr_debug("pci_space: 0x%08x pci_addr:0x%016llx ",
|
||||||
pci_space, pci_addr);
|
range.pci_space, range.pci_addr);
|
||||||
pr_debug("cpu_addr:0x%016llx size:0x%016llx\n",
|
pr_debug("cpu_addr:0x%016llx size:0x%016llx\n",
|
||||||
cpu_addr, size);
|
range.cpu_addr, range.size);
|
||||||
|
|
||||||
ranges += np;
|
|
||||||
|
|
||||||
/* If we failed translation or got a zero-sized region
|
/* If we failed translation or got a zero-sized region
|
||||||
* (some FW try to feed us with non sensical zero sized regions
|
* (some FW try to feed us with non sensical zero sized regions
|
||||||
* such as power3 which look like some kind of attempt
|
* such as power3 which look like some kind of attempt
|
||||||
* at exposing the VGA memory hole)
|
* at exposing the VGA memory hole)
|
||||||
*/
|
*/
|
||||||
if (cpu_addr == OF_BAD_ADDR || size == 0)
|
if (range.cpu_addr == OF_BAD_ADDR || range.size == 0)
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
/* Now consume following elements while they are contiguous */
|
|
||||||
for (; rlen >= np * sizeof(u32);
|
|
||||||
ranges += np, rlen -= np * 4) {
|
|
||||||
if (ranges[0] != pci_space)
|
|
||||||
break;
|
|
||||||
pci_next = of_read_number(ranges + 1, 2);
|
|
||||||
cpu_next = of_translate_address(dev, ranges + 3);
|
|
||||||
if (pci_next != pci_addr + size ||
|
|
||||||
cpu_next != cpu_addr + size)
|
|
||||||
break;
|
|
||||||
size += of_read_number(ranges + pna + 3, 2);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Act based on address space type */
|
/* Act based on address space type */
|
||||||
res = NULL;
|
res = NULL;
|
||||||
switch ((pci_space >> 24) & 0x3) {
|
switch (range.flags & IORESOURCE_TYPE_BITS) {
|
||||||
case 1: /* PCI IO space */
|
case IORESOURCE_IO:
|
||||||
pr_info(" IO 0x%016llx..0x%016llx -> 0x%016llx\n",
|
pr_info(" IO 0x%016llx..0x%016llx -> 0x%016llx\n",
|
||||||
cpu_addr, cpu_addr + size - 1, pci_addr);
|
range.cpu_addr, range.cpu_addr + range.size - 1,
|
||||||
|
range.pci_addr);
|
||||||
|
|
||||||
/* We support only one IO range */
|
/* We support only one IO range */
|
||||||
if (hose->pci_io_size) {
|
if (hose->pci_io_size) {
|
||||||
|
@ -725,11 +700,12 @@ void pci_process_bridge_OF_ranges(struct pci_controller *hose,
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
/* On 32 bits, limit I/O space to 16MB */
|
/* On 32 bits, limit I/O space to 16MB */
|
||||||
if (size > 0x01000000)
|
if (range.size > 0x01000000)
|
||||||
size = 0x01000000;
|
range.size = 0x01000000;
|
||||||
|
|
||||||
/* 32 bits needs to map IOs here */
|
/* 32 bits needs to map IOs here */
|
||||||
hose->io_base_virt = ioremap(cpu_addr, size);
|
hose->io_base_virt = ioremap(range.cpu_addr,
|
||||||
|
range.size);
|
||||||
|
|
||||||
/* Expect trouble if pci_addr is not 0 */
|
/* Expect trouble if pci_addr is not 0 */
|
||||||
if (primary)
|
if (primary)
|
||||||
|
@ -738,19 +714,20 @@ void pci_process_bridge_OF_ranges(struct pci_controller *hose,
|
||||||
/* pci_io_size and io_base_phys always represent IO
|
/* pci_io_size and io_base_phys always represent IO
|
||||||
* space starting at 0 so we factor in pci_addr
|
* space starting at 0 so we factor in pci_addr
|
||||||
*/
|
*/
|
||||||
hose->pci_io_size = pci_addr + size;
|
hose->pci_io_size = range.pci_addr + range.size;
|
||||||
hose->io_base_phys = cpu_addr - pci_addr;
|
hose->io_base_phys = range.cpu_addr - range.pci_addr;
|
||||||
|
|
||||||
/* Build resource */
|
/* Build resource */
|
||||||
res = &hose->io_resource;
|
res = &hose->io_resource;
|
||||||
res->flags = IORESOURCE_IO;
|
range.cpu_addr = range.pci_addr;
|
||||||
res->start = pci_addr;
|
|
||||||
break;
|
break;
|
||||||
case 2: /* PCI Memory space */
|
case IORESOURCE_MEM:
|
||||||
case 3: /* PCI 64 bits Memory space */
|
|
||||||
pr_info(" MEM 0x%016llx..0x%016llx -> 0x%016llx %s\n",
|
pr_info(" MEM 0x%016llx..0x%016llx -> 0x%016llx %s\n",
|
||||||
cpu_addr, cpu_addr + size - 1, pci_addr,
|
range.cpu_addr, range.cpu_addr + range.size - 1,
|
||||||
(pci_space & 0x40000000) ? "Prefetch" : "");
|
range.pci_addr,
|
||||||
|
(range.pci_space & 0x40000000) ?
|
||||||
|
"Prefetch" : "");
|
||||||
|
|
||||||
/* We support only 3 memory ranges */
|
/* We support only 3 memory ranges */
|
||||||
if (memno >= 3) {
|
if (memno >= 3) {
|
||||||
|
@ -758,13 +735,13 @@ void pci_process_bridge_OF_ranges(struct pci_controller *hose,
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
/* Handles ISA memory hole space here */
|
/* Handles ISA memory hole space here */
|
||||||
if (pci_addr == 0) {
|
if (range.pci_addr == 0) {
|
||||||
isa_mb = cpu_addr;
|
isa_mb = range.cpu_addr;
|
||||||
isa_hole = memno;
|
isa_hole = memno;
|
||||||
if (primary || isa_mem_base == 0)
|
if (primary || isa_mem_base == 0)
|
||||||
isa_mem_base = cpu_addr;
|
isa_mem_base = range.cpu_addr;
|
||||||
hose->isa_mem_phys = cpu_addr;
|
hose->isa_mem_phys = range.cpu_addr;
|
||||||
hose->isa_mem_size = size;
|
hose->isa_mem_size = range.size;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* We get the PCI/Mem offset from the first range or
|
/* We get the PCI/Mem offset from the first range or
|
||||||
|
@ -772,30 +749,23 @@ void pci_process_bridge_OF_ranges(struct pci_controller *hose,
|
||||||
* hole. If they don't match, bugger.
|
* hole. If they don't match, bugger.
|
||||||
*/
|
*/
|
||||||
if (memno == 0 ||
|
if (memno == 0 ||
|
||||||
(isa_hole >= 0 && pci_addr != 0 &&
|
(isa_hole >= 0 && range.pci_addr != 0 &&
|
||||||
hose->pci_mem_offset == isa_mb))
|
hose->pci_mem_offset == isa_mb))
|
||||||
hose->pci_mem_offset = cpu_addr - pci_addr;
|
hose->pci_mem_offset = range.cpu_addr -
|
||||||
else if (pci_addr != 0 &&
|
range.pci_addr;
|
||||||
hose->pci_mem_offset != cpu_addr - pci_addr) {
|
else if (range.pci_addr != 0 &&
|
||||||
|
hose->pci_mem_offset != range.cpu_addr -
|
||||||
|
range.pci_addr) {
|
||||||
pr_info(" \\--> Skipped (offset mismatch) !\n");
|
pr_info(" \\--> Skipped (offset mismatch) !\n");
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Build resource */
|
/* Build resource */
|
||||||
res = &hose->mem_resources[memno++];
|
res = &hose->mem_resources[memno++];
|
||||||
res->flags = IORESOURCE_MEM;
|
|
||||||
if (pci_space & 0x40000000)
|
|
||||||
res->flags |= IORESOURCE_PREFETCH;
|
|
||||||
res->start = cpu_addr;
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if (res != NULL) {
|
if (res != NULL)
|
||||||
res->name = dev->full_name;
|
of_pci_range_to_resource(&range, dev, res);
|
||||||
res->end = res->start + size - 1;
|
|
||||||
res->parent = NULL;
|
|
||||||
res->sibling = NULL;
|
|
||||||
res->child = NULL;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* If there's an ISA hole and the pci_mem_offset is -not- matching
|
/* If there's an ISA hole and the pci_mem_offset is -not- matching
|
||||||
|
|
Loading…
Add table
Reference in a new issue