As EFI stub code could put them high when on 32bit or with exactmap=
on 64bit conf.

Check if the range is mapped, otherwise allocate new one and have
the rom data copied. So we could access them directly.

Signed-off-by: Yinghai Lu <ying...@kernel.org>
---
 arch/x86/pci/common.c | 47 +++++++++++++++++++++++++++++++++++++++++++++--
 1 file changed, 45 insertions(+), 2 deletions(-)

diff --git a/arch/x86/pci/common.c b/arch/x86/pci/common.c
index 67dc2a9..15e1b3f 100644
--- a/arch/x86/pci/common.c
+++ b/arch/x86/pci/common.c
@@ -697,6 +697,48 @@ struct firmware_setup_pci_entry {
 
 static LIST_HEAD(setup_pci_entries);
 
+static phys_addr_t check_copy(phys_addr_t start, unsigned long size)
+{
+       unsigned long start_pfn = PFN_DOWN(start);
+       unsigned long end_pfn = PFN_UP(start + size);
+       unsigned char *p, *q;
+       phys_addr_t pa_p, pa_q;
+       long sz = size;
+
+       if (pfn_range_is_mapped(start_pfn, end_pfn))
+               return start;
+
+       /* allocate and copy */
+       pa_p = memblock_alloc(size, PAGE_SIZE);
+       if (!pa_p)
+               return start;
+
+       p = phys_to_virt(pa_p);
+
+       pa_q = start;
+       while (sz > 0) {
+               long chunk_size = 64<<10;
+
+               if (chunk_size > sz)
+                       chunk_size = sz;
+
+               q = early_memremap(pa_q, chunk_size);
+               if (!q) {
+                       memblock_free(pa_p, size);
+                       return start;
+               }
+               memcpy(p, q, chunk_size);
+               early_memunmap(q, chunk_size);
+               p += chunk_size;
+               pa_q += chunk_size;
+               sz -= chunk_size;
+       }
+
+       memblock_free(start, size);
+
+       return pa_p;
+}
+
 int __init fill_setup_pci_entries(void)
 {
        struct setup_data *data;
@@ -726,8 +768,9 @@ int __init fill_setup_pci_entries(void)
                entry->vendor = rom->vendor;
                entry->devid = rom->devid;
                entry->pcilen = rom->pcilen;
-               entry->romdata = pa_data +
-                                offsetof(struct pci_setup_rom, romdata);
+               entry->romdata = check_copy(pa_data +
+                                     offsetof(struct pci_setup_rom, romdata),
+                                     rom->pcilen);
 
                list_add(&entry->list, &setup_pci_entries);
 
-- 
1.8.4.5

--
To unsubscribe from this list: send the line "unsubscribe linux-efi" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to