arch/openrisc/kernel/dma.c

   1 /*
   2  * OpenRISC Linux
   3  *
   4  * Linux architectural port borrowing liberally from similar works of
   5  * others.  All original copyrights apply as per the original source
   6  * declaration.
   7  *
   8  * Modifications for the OpenRISC architecture:
   9  * Copyright (C) 2003 Matjaz Breskvar <phoenix@bsemi.com>
  10  * Copyright (C) 2010-2011 Jonas Bonn <jonas@southpole.se>
  11  *
  12  *      This program is free software; you can redistribute it and/or
  13  *      modify it under the terms of the GNU General Public License
  14  *      as published by the Free Software Foundation; either version
  15  *      2 of the License, or (at your option) any later version.
  16  *
  17  * DMA mapping callbacks...
  18  * As alloc_coherent is the only DMA callback being used currently, that's
  19  * the only thing implemented properly.  The rest need looking into...
  20  */
  21
  22 #include <linux/dma-mapping.h>
  23 #include <linux/dma-debug.h>
  24
  25 #include <asm/cpuinfo.h>
  26 #include <asm/spr_defs.h>
  27 #include <asm/tlbflush.h>
  28
  29 static int page_set_nocache(pte_t *pte, unsigned long addr,
  30                             unsigned long next, struct mm_walk *walk)
  31 {
  32         unsigned long cl;
  33
  34         pte_val(*pte) |= _PAGE_CI;
  35
  36         /*
  37          * Flush the page out of the TLB so that the new page flags get
  38          * picked up next time there's an access
  39          */
  40         flush_tlb_page(NULL, addr);
  41
  42         /* Flush page out of dcache */
  43         for (cl = __pa(addr); cl < __pa(next); cl += cpuinfo.dcache_block_size)
  44                 mtspr(SPR_DCBFR, cl);
  45
  46         return 0;
  47 }
  48
  49 static int page_clear_nocache(pte_t *pte, unsigned long addr,
  50                               unsigned long next, struct mm_walk *walk)
  51 {
  52         pte_val(*pte) &= ~_PAGE_CI;
  53
  54         /*
  55          * Flush the page out of the TLB so that the new page flags get
  56          * picked up next time there's an access
  57          */
  58         flush_tlb_page(NULL, addr);
  59
  60         return 0;
  61 }
  62
  63 /*
  64  * Alloc "coherent" memory, which for OpenRISC means simply uncached.
  65  *
  66  * This function effectively just calls __get_free_pages, sets the
  67  * cache-inhibit bit on those pages, and makes sure that the pages are
  68  * flushed out of the cache before they are used.
  69  *
  70  */
  71 void *or1k_dma_alloc_coherent(struct device *dev, size_t size,
  72                               dma_addr_t *dma_handle, gfp_t gfp)
  73 {
  74         unsigned long va;
  75         void *page;
  76         struct mm_walk walk = {
  77                 .pte_entry = page_set_nocache,
  78                 .mm = &init_mm
  79         };
  80
  81         page = alloc_pages_exact(size, gfp);
  82         if (!page)
  83                 return NULL;
  84
  85         /* This gives us the real physical address of the first page. */
  86         *dma_handle = __pa(page);
  87
  88         va = (unsigned long)page;
  89
  90         /*
  91          * We need to iterate through the pages, clearing the dcache for
  92          * them and setting the cache-inhibit bit.
  93          */
  94         if (walk_page_range(va, va + size, &walk)) {
  95                 free_pages_exact(page, size);
  96                 return NULL;
  97         }
  98
  99         return (void *)va;
 100 }
 101
 102 void or1k_dma_free_coherent(struct device *dev, size_t size, void *vaddr,
 103                             dma_addr_t dma_handle)
 104 {
 105         unsigned long va = (unsigned long)vaddr;
 106         struct mm_walk walk = {
 107                 .pte_entry = page_clear_nocache,
 108                 .mm = &init_mm
 109         };
 110
 111         /* walk_page_range shouldn't be able to fail here */
 112         WARN_ON(walk_page_range(va, va + size, &walk));
 113
 114         free_pages_exact(vaddr, size);
 115 }
 116
 117 dma_addr_t or1k_map_page(struct device *dev, struct page *page,
 118                          unsigned long offset, size_t size,
 119                          enum dma_data_direction dir,
 120                          struct dma_attrs *attrs)
 121 {
 122         unsigned long cl;
 123         dma_addr_t addr = page_to_phys(page) + offset;
 124
 125         switch (dir) {
 126         case DMA_TO_DEVICE:
 127                 /* Flush the dcache for the requested range */
 128                 for (cl = addr; cl < addr + size;
 129                      cl += cpuinfo.dcache_block_size)
 130                         mtspr(SPR_DCBFR, cl);
 131                 break;
 132         case DMA_FROM_DEVICE:
 133                 /* Invalidate the dcache for the requested range */
 134                 for (cl = addr; cl < addr + size;
 135                      cl += cpuinfo.dcache_block_size)
 136                         mtspr(SPR_DCBIR, cl);
 137                 break;
 138         default:
 139                 /*
 140                  * NOTE: If dir == DMA_BIDIRECTIONAL then there's no need to
 141                  * flush nor invalidate the cache here as the area will need
 142                  * to be manually synced anyway.
 143                  */
 144                 break;
 145         }
 146
 147         return addr;
 148 }
 149
 150 void or1k_unmap_page(struct device *dev, dma_addr_t dma_handle,
 151                      size_t size, enum dma_data_direction dir,
 152                      struct dma_attrs *attrs)
 153 {
 154         /* Nothing special to do here... */
 155 }
 156
 157 int or1k_map_sg(struct device *dev, struct scatterlist *sg,
 158                 int nents, enum dma_data_direction dir,
 159                 struct dma_attrs *attrs)
 160 {
 161         struct scatterlist *s;
 162         int i;
 163
 164         for_each_sg(sg, s, nents, i) {
 165                 s->dma_address = or1k_map_page(dev, sg_page(s), s->offset,
 166                                                s->length, dir, NULL);
 167         }
 168
 169         return nents;
 170 }
 171
 172 void or1k_unmap_sg(struct device *dev, struct scatterlist *sg,
 173                    int nents, enum dma_data_direction dir,
 174                    struct dma_attrs *attrs)
 175 {
 176         struct scatterlist *s;
 177         int i;
 178
 179         for_each_sg(sg, s, nents, i) {
 180                 or1k_unmap_page(dev, sg_dma_address(s), sg_dma_len(s), dir, NULL);
 181         }
 182 }
 183
 184 void or1k_sync_single_for_cpu(struct device *dev,
 185                               dma_addr_t dma_handle, size_t size,
 186                               enum dma_data_direction dir)
 187 {
 188         unsigned long cl;
 189         dma_addr_t addr = dma_handle;
 190
 191         /* Invalidate the dcache for the requested range */
 192         for (cl = addr; cl < addr + size; cl += cpuinfo.dcache_block_size)
 193                 mtspr(SPR_DCBIR, cl);
 194 }
 195
 196 void or1k_sync_single_for_device(struct device *dev,
 197                                  dma_addr_t dma_handle, size_t size,
 198                                  enum dma_data_direction dir)
 199 {
 200         unsigned long cl;
 201         dma_addr_t addr = dma_handle;
 202
 203         /* Flush the dcache for the requested range */
 204         for (cl = addr; cl < addr + size; cl += cpuinfo.dcache_block_size)
 205                 mtspr(SPR_DCBFR, cl);
 206 }
 207
 208 /* Number of entries preallocated for DMA-API debugging */
 209 #define PREALLOC_DMA_DEBUG_ENTRIES (1 << 16)
 210
 211 static int __init dma_init(void)
 212 {
 213         dma_debug_init(PREALLOC_DMA_DEBUG_ENTRIES);
 214
 215         return 0;
 216 }
 217 fs_initcall(dma_init);