microblaze: Preliminary support for dma drivers

I found several problems for ll_temac driver and on system with WB.
This early fix should fix it. I will clean this patch before I will add
it to mainline

Signed-off-by: Michal Simek <monstr@monstr.eu>

1 files changed, 12 insertions, 6 deletions

diff --git a/arch/microblaze/kernel/dma.c b/arch/microblaze/kernel/dma.c
index 64bc39f40ba7..f230a8de0bcd 100644
--- a/arch/microblaze/kernel/dma.c
+++ b/arch/microblaze/kernel/dma.c
@@ -21,10 +21,10 @@
  * default the offset is PCI_DRAM_OFFSET.
  */
 
-static inline void __dma_sync_page(void *vaddr, unsigned long offset,
+static inline void __dma_sync_page(void *paddr, unsigned long offset,
                                 size_t size, enum dma_data_direction direction)
 {
-        unsigned long start = virt_to_phys(vaddr);
+        unsigned long start = (unsigned long)paddr;
 
         switch (direction) {
         case DMA_TO_DEVICE:
@@ -79,10 +79,12 @@ static int dma_direct_map_sg(struct device *dev, struct scatterlist *sgl,
         struct scatterlist *sg;
         int i;
 
+        /* FIXME this part of code is untested */
         for_each_sg(sgl, sg, nents, i) {
                 sg->dma_address = sg_phys(sg) + get_dma_direct_offset(dev);
                 sg->dma_length = sg->length;
-                __dma_sync_page(sg_page(sg), sg->offset, sg->length, direction);
+                __dma_sync_page(page_to_phys(sg_page(sg)), sg->offset,
+                                                        sg->length, direction);
         }
 
         return nents;
@@ -107,7 +109,7 @@ static inline dma_addr_t dma_direct_map_page(struct device *dev,
                                              struct dma_attrs *attrs)
 {
         BUG_ON(direction == DMA_NONE);
-        __dma_sync_page(page, offset, size, direction);
+        __dma_sync_page(page_to_phys(page), offset, size, direction);
         return page_to_phys(page) + offset + get_dma_direct_offset(dev);
 }
 
@@ -117,8 +119,12 @@ static inline void dma_direct_unmap_page(struct device *dev,
                                          enum dma_data_direction direction,
                                          struct dma_attrs *attrs)
 {
-/* There is not necessary to do cache cleanup */
-        /* __dma_sync_page(dma_address, 0 , size, direction); */
+/* There is not necessary to do cache cleanup
+ *
+ * phys_to_virt is here because in __dma_sync_page is __virt_to_phys and
+ * dma_address is physical address
+ */
+        __dma_sync_page((void *)dma_address, 0 , size, direction);
 }
 
 struct dma_map_ops dma_direct_ops = {