xen: swiotlb: handle sizeof(dma_addr_t) != sizeof(phys_addr_t)

The use of phys_to_machine and machine_to_phys in the phys<=>bus conversions
causes us to lose the top bits of the DMA address if the size of a DMA address is not the same as the size of the phyiscal address.

This can happen in practice on ARM where foreign pages can be above 4GB even
though the local kernel does not have LPAE page tables enabled (which is
totally reasonable if the guest does not itself have >4GB of RAM). In this
case the kernel still maps the foreign pages at a phys addr below 4G (as it
must) but the resulting DMA address (returned by the grant map operation) is
much higher.

This is analogous to a hardware device which has its view of RAM mapped up
high for some reason.

This patch makes I/O to foreign pages (specifically blkif) work on 32-bit ARM
systems with more than 4GB of RAM.

Signed-off-by: Ian Campbell <ian.campbell@citrix.com>
Signed-off-by: Stefano Stabellini <stefano.stabellini@eu.citrix.com>

1 files changed, 20 insertions, 2 deletions

diff --git a/drivers/xen/swiotlb-xen.c b/drivers/xen/swiotlb-xen.c
index 1eac0731c349..ebd8f218a788 100644
--- a/drivers/xen/swiotlb-xen.c
+++ b/drivers/xen/swiotlb-xen.c
@@ -75,14 +75,32 @@ static unsigned long xen_io_tlb_nslabs;
 
 static u64 start_dma_addr;
 
+/*
+ * Both of these functions should avoid PFN_PHYS because phys_addr_t
+ * can be 32bit when dma_addr_t is 64bit leading to a loss in
+ * information if the shift is done before casting to 64bit.
+ */
 static inline dma_addr_t xen_phys_to_bus(phys_addr_t paddr)
 {
-        return phys_to_machine(XPADDR(paddr)).maddr;
+        unsigned long mfn = pfn_to_mfn(PFN_DOWN(paddr));
+        dma_addr_t dma = (dma_addr_t)mfn << PAGE_SHIFT;
+
+        dma |= paddr & ~PAGE_MASK;
+
+        return dma;
 }
 
 static inline phys_addr_t xen_bus_to_phys(dma_addr_t baddr)
 {
-        return machine_to_phys(XMADDR(baddr)).paddr;
+        unsigned long pfn = mfn_to_pfn(PFN_DOWN(baddr));
+        dma_addr_t dma = (dma_addr_t)pfn << PAGE_SHIFT;
+        phys_addr_t paddr = dma;
+
+        BUG_ON(paddr != dma); /* truncation has occurred, should never happen */
+
+        paddr |= baddr & ~PAGE_MASK;
+
+        return paddr;
 }
 
 static inline dma_addr_t xen_virt_to_bus(void *address)