hc
2023-10-25 6c2073b7aa40e29d0eca7d571dd7bc590c7ecaa7
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corporation
 *
 * Provide default implementations of the DMA mapping callbacks for
 * busses using the iommu infrastructure
 */
 
#include <linux/export.h>
#include <asm/iommu.h>
 
/*
 * Generic iommu implementation
 */
 
/* Allocates a contiguous real buffer and creates mappings over it.
 * Returns the virtual address of the buffer and sets dma_handle
 * to the dma address (mapping) of the first page.
 */
static void *dma_iommu_alloc_coherent(struct device *dev, size_t size,
                     dma_addr_t *dma_handle, gfp_t flag,
                     unsigned long attrs)
{
   return iommu_alloc_coherent(dev, get_iommu_table_base(dev), size,
                   dma_handle, dev->coherent_dma_mask, flag,
                   dev_to_node(dev));
}
 
static void dma_iommu_free_coherent(struct device *dev, size_t size,
                   void *vaddr, dma_addr_t dma_handle,
                   unsigned long attrs)
{
   iommu_free_coherent(get_iommu_table_base(dev), size, vaddr, dma_handle);
}
 
/* Creates TCEs for a user provided buffer.  The user buffer must be
 * contiguous real kernel storage (not vmalloc).  The address passed here
 * comprises a page address and offset into that page. The dma_addr_t
 * returned will point to the same byte within the page as was passed in.
 */
static dma_addr_t dma_iommu_map_page(struct device *dev, struct page *page,
                    unsigned long offset, size_t size,
                    enum dma_data_direction direction,
                    unsigned long attrs)
{
   return iommu_map_page(dev, get_iommu_table_base(dev), page, offset,
                 size, device_to_mask(dev), direction, attrs);
}
 
 
static void dma_iommu_unmap_page(struct device *dev, dma_addr_t dma_handle,
                size_t size, enum dma_data_direction direction,
                unsigned long attrs)
{
   iommu_unmap_page(get_iommu_table_base(dev), dma_handle, size, direction,
            attrs);
}
 
 
static int dma_iommu_map_sg(struct device *dev, struct scatterlist *sglist,
               int nelems, enum dma_data_direction direction,
               unsigned long attrs)
{
   return ppc_iommu_map_sg(dev, get_iommu_table_base(dev), sglist, nelems,
               device_to_mask(dev), direction, attrs);
}
 
static void dma_iommu_unmap_sg(struct device *dev, struct scatterlist *sglist,
       int nelems, enum dma_data_direction direction,
       unsigned long attrs)
{
   ppc_iommu_unmap_sg(get_iommu_table_base(dev), sglist, nelems,
              direction, attrs);
}
 
/* We support DMA to/from any memory page via the iommu */
int dma_iommu_dma_supported(struct device *dev, u64 mask)
{
   struct iommu_table *tbl = get_iommu_table_base(dev);
 
   if (!tbl) {
       dev_info(dev, "Warning: IOMMU dma not supported: mask 0x%08llx"
           ", table unavailable\n", mask);
       return 0;
   }
 
   if (tbl->it_offset > (mask >> tbl->it_page_shift)) {
       dev_info(dev, "Warning: IOMMU offset too big for device mask\n");
       dev_info(dev, "mask: 0x%08llx, table offset: 0x%08lx\n",
               mask, tbl->it_offset << tbl->it_page_shift);
       return 0;
   } else
       return 1;
}
 
static u64 dma_iommu_get_required_mask(struct device *dev)
{
   struct iommu_table *tbl = get_iommu_table_base(dev);
   u64 mask;
   if (!tbl)
       return 0;
 
   mask = 1ULL << (fls_long(tbl->it_offset + tbl->it_size) +
           tbl->it_page_shift - 1);
   mask += mask - 1;
 
   return mask;
}
 
int dma_iommu_mapping_error(struct device *dev, dma_addr_t dma_addr)
{
   return dma_addr == IOMMU_MAPPING_ERROR;
}
 
struct dma_map_ops dma_iommu_ops = {
   .alloc            = dma_iommu_alloc_coherent,
   .free            = dma_iommu_free_coherent,
   .mmap            = dma_nommu_mmap_coherent,
   .map_sg            = dma_iommu_map_sg,
   .unmap_sg        = dma_iommu_unmap_sg,
   .dma_supported        = dma_iommu_dma_supported,
   .map_page        = dma_iommu_map_page,
   .unmap_page        = dma_iommu_unmap_page,
   .get_required_mask    = dma_iommu_get_required_mask,
   .mapping_error        = dma_iommu_mapping_error,
};
EXPORT_SYMBOL(dma_iommu_ops);