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#include <linux/mm.h>
38#include <linux/dma-mapping.h>
39#include <linux/sched.h>
40#include <linux/hugetlb.h>
41
42#include "uverbs.h"
43
44#define IB_UMEM_MAX_PAGE_CHUNK \
45 ((PAGE_SIZE - offsetof(struct ib_umem_chunk, page_list)) / \
46 ((void *) &((struct ib_umem_chunk *) 0)->page_list[1] - \
47 (void *) &((struct ib_umem_chunk *) 0)->page_list[0]))
48
49static void __ib_umem_release(struct ib_device *dev, struct ib_umem *umem, int dirty)
50{
51 struct ib_umem_chunk *chunk, *tmp;
52 int i;
53
54 list_for_each_entry_safe(chunk, tmp, &umem->chunk_list, list) {
55 ib_dma_unmap_sg(dev, chunk->page_list,
56 chunk->nents, DMA_BIDIRECTIONAL);
57 for (i = 0; i < chunk->nents; ++i) {
58 struct page *page = sg_page(&chunk->page_list[i]);
59
60 if (umem->writable && dirty)
61 set_page_dirty_lock(page);
62 put_page(page);
63 }
64
65 kfree(chunk);
66 }
67}
68
69
70
71
72
73
74
75
76struct ib_umem *ib_umem_get(struct ib_ucontext *context, unsigned long addr,
77 size_t size, int access)
78{
79 struct ib_umem *umem;
80 struct page **page_list;
81 struct vm_area_struct **vma_list;
82 struct ib_umem_chunk *chunk;
83 unsigned long locked;
84 unsigned long lock_limit;
85 unsigned long cur_base;
86 unsigned long npages;
87 int ret;
88 int off;
89 int i;
90
91 if (!can_do_mlock())
92 return ERR_PTR(-EPERM);
93
94 umem = kmalloc(sizeof *umem, GFP_KERNEL);
95 if (!umem)
96 return ERR_PTR(-ENOMEM);
97
98 umem->context = context;
99 umem->length = size;
100 umem->offset = addr & ~PAGE_MASK;
101 umem->page_size = PAGE_SIZE;
102
103
104
105
106
107
108
109 umem->writable = !!(access & ~IB_ACCESS_REMOTE_READ);
110
111
112 umem->hugetlb = 1;
113
114 INIT_LIST_HEAD(&umem->chunk_list);
115
116 page_list = (struct page **) __get_free_page(GFP_KERNEL);
117 if (!page_list) {
118 kfree(umem);
119 return ERR_PTR(-ENOMEM);
120 }
121
122
123
124
125
126 vma_list = (struct vm_area_struct **) __get_free_page(GFP_KERNEL);
127 if (!vma_list)
128 umem->hugetlb = 0;
129
130 npages = PAGE_ALIGN(size + umem->offset) >> PAGE_SHIFT;
131
132 down_write(¤t->mm->mmap_sem);
133
134 locked = npages + current->mm->locked_vm;
135 lock_limit = current->signal->rlim[RLIMIT_MEMLOCK].rlim_cur >> PAGE_SHIFT;
136
137 if ((locked > lock_limit) && !capable(CAP_IPC_LOCK)) {
138 ret = -ENOMEM;
139 goto out;
140 }
141
142 cur_base = addr & PAGE_MASK;
143
144 ret = 0;
145 while (npages) {
146 ret = get_user_pages(current, current->mm, cur_base,
147 min_t(int, npages,
148 PAGE_SIZE / sizeof (struct page *)),
149 1, !umem->writable, page_list, vma_list);
150
151 if (ret < 0)
152 goto out;
153
154 cur_base += ret * PAGE_SIZE;
155 npages -= ret;
156
157 off = 0;
158
159 while (ret) {
160 chunk = kmalloc(sizeof *chunk + sizeof (struct scatterlist) *
161 min_t(int, ret, IB_UMEM_MAX_PAGE_CHUNK),
162 GFP_KERNEL);
163 if (!chunk) {
164 ret = -ENOMEM;
165 goto out;
166 }
167
168 chunk->nents = min_t(int, ret, IB_UMEM_MAX_PAGE_CHUNK);
169 sg_init_table(chunk->page_list, chunk->nents);
170 for (i = 0; i < chunk->nents; ++i) {
171 if (vma_list &&
172 !is_vm_hugetlb_page(vma_list[i + off]))
173 umem->hugetlb = 0;
174 sg_set_page(&chunk->page_list[i], page_list[i + off], PAGE_SIZE, 0);
175 }
176
177 chunk->nmap = ib_dma_map_sg(context->device,
178 &chunk->page_list[0],
179 chunk->nents,
180 DMA_BIDIRECTIONAL);
181 if (chunk->nmap <= 0) {
182 for (i = 0; i < chunk->nents; ++i)
183 put_page(sg_page(&chunk->page_list[i]));
184 kfree(chunk);
185
186 ret = -ENOMEM;
187 goto out;
188 }
189
190 ret -= chunk->nents;
191 off += chunk->nents;
192 list_add_tail(&chunk->list, &umem->chunk_list);
193 }
194
195 ret = 0;
196 }
197
198out:
199 if (ret < 0) {
200 __ib_umem_release(context->device, umem, 0);
201 kfree(umem);
202 } else
203 current->mm->locked_vm = locked;
204
205 up_write(¤t->mm->mmap_sem);
206 if (vma_list)
207 free_page((unsigned long) vma_list);
208 free_page((unsigned long) page_list);
209
210 return ret < 0 ? ERR_PTR(ret) : umem;
211}
212EXPORT_SYMBOL(ib_umem_get);
213
214static void ib_umem_account(struct work_struct *work)
215{
216 struct ib_umem *umem = container_of(work, struct ib_umem, work);
217
218 down_write(&umem->mm->mmap_sem);
219 umem->mm->locked_vm -= umem->diff;
220 up_write(&umem->mm->mmap_sem);
221 mmput(umem->mm);
222 kfree(umem);
223}
224
225
226
227
228
229void ib_umem_release(struct ib_umem *umem)
230{
231 struct ib_ucontext *context = umem->context;
232 struct mm_struct *mm;
233 unsigned long diff;
234
235 __ib_umem_release(umem->context->device, umem, 1);
236
237 mm = get_task_mm(current);
238 if (!mm) {
239 kfree(umem);
240 return;
241 }
242
243 diff = PAGE_ALIGN(umem->length + umem->offset) >> PAGE_SHIFT;
244
245
246
247
248
249
250
251
252
253 if (context->closing) {
254 if (!down_write_trylock(&mm->mmap_sem)) {
255 INIT_WORK(&umem->work, ib_umem_account);
256 umem->mm = mm;
257 umem->diff = diff;
258
259 schedule_work(&umem->work);
260 return;
261 }
262 } else
263 down_write(&mm->mmap_sem);
264
265 current->mm->locked_vm -= diff;
266 up_write(&mm->mmap_sem);
267 mmput(mm);
268 kfree(umem);
269}
270EXPORT_SYMBOL(ib_umem_release);
271
272int ib_umem_page_count(struct ib_umem *umem)
273{
274 struct ib_umem_chunk *chunk;
275 int shift;
276 int i;
277 int n;
278
279 shift = ilog2(umem->page_size);
280
281 n = 0;
282 list_for_each_entry(chunk, &umem->chunk_list, list)
283 for (i = 0; i < chunk->nmap; ++i)
284 n += sg_dma_len(&chunk->page_list[i]) >> shift;
285
286 return n;
287}
288EXPORT_SYMBOL(ib_umem_page_count);
289