]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/infiniband/hw/ehca/ehca_mrmw.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit...
[net-next-2.6.git] / drivers / infiniband / hw / ehca / ehca_mrmw.c
CommitLineData
fab97220
HS		 1/*
2 * IBM eServer eHCA Infiniband device driver for Linux on POWER
3 *
4 * MR/MW functions
5 *
6 * Authors: Dietmar Decker <ddecker@de.ibm.com>
7 * Christoph Raisch <raisch@de.ibm.com>
5bb7d929 8 * Hoang-Nam Nguyen <hnguyen@de.ibm.com>
fab97220
HS		 9 *
10 * Copyright (c) 2005 IBM Corporation
11 *
12 * All rights reserved.
13 *
14 * This source code is distributed under a dual license of GPL v2.0 and OpenIB
15 * BSD.
16 *
17 * OpenIB BSD License
18 *
19 * Redistribution and use in source and binary forms, with or without
20 * modification, are permitted provided that the following conditions are met:
21 *
22 * Redistributions of source code must retain the above copyright notice, this
23 * list of conditions and the following disclaimer.
24 *
25 * Redistributions in binary form must reproduce the above copyright notice,
26 * this list of conditions and the following disclaimer in the documentation
27 * and/or other materials
28 * provided with the distribution.
29 *
30 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
31 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
32 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
33 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
34 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
35 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
36 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
37 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
38 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
39 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
40 * POSSIBILITY OF SUCH DAMAGE.
41 */
42
5a0e3ad6 43#include <linux/slab.h>
05d989f9
HNN		 44#include <rdma/ib_umem.h>
45
fab97220
HS		 46#include "ehca_iverbs.h"
47#include "ehca_mrmw.h"
48#include "hcp_if.h"
49#include "hipz_hw.h"
50
2492398e
HNN		 51#define NUM_CHUNKS(length, chunk_size) \
52 (((length) + (chunk_size - 1)) / (chunk_size))
3a31c419 53
4e4e74ca
HNN		 54/* max number of rpages (per hcall register_rpages) */
55#define MAX_RPAGES 512
56
0cf89dcd
HH		 57/* DMEM toleration management */
58#define EHCA_SECTSHIFT SECTION_SIZE_BITS
59#define EHCA_SECTSIZE (1UL << EHCA_SECTSHIFT)
60#define EHCA_HUGEPAGESHIFT 34
61#define EHCA_HUGEPAGE_SIZE (1UL << EHCA_HUGEPAGESHIFT)
62#define EHCA_HUGEPAGE_PFN_MASK ((EHCA_HUGEPAGE_SIZE - 1) >> PAGE_SHIFT)
63#define EHCA_INVAL_ADDR 0xFFFFFFFFFFFFFFFFULL
64#define EHCA_DIR_INDEX_SHIFT 13 /* 8k Entries in 64k block */
65#define EHCA_TOP_INDEX_SHIFT (EHCA_DIR_INDEX_SHIFT * 2)
66#define EHCA_MAP_ENTRIES (1 << EHCA_DIR_INDEX_SHIFT)
67#define EHCA_TOP_MAP_SIZE (0x10000) /* currently fixed map size */
68#define EHCA_DIR_MAP_SIZE (0x10000)
69#define EHCA_ENT_MAP_SIZE (0x10000)
70#define EHCA_INDEX_MASK (EHCA_MAP_ENTRIES - 1)
71
72static unsigned long ehca_mr_len;
73
74/*
75 * Memory map data structures
76 */
77struct ehca_dir_bmap {
78 u64 ent[EHCA_MAP_ENTRIES];
79};
80struct ehca_top_bmap {
81 struct ehca_dir_bmap *dir[EHCA_MAP_ENTRIES];
82};
83struct ehca_bmap {
84 struct ehca_top_bmap *top[EHCA_MAP_ENTRIES];
85};
86
87static struct ehca_bmap *ehca_bmap;
88
fab97220
HS		 89static struct kmem_cache *mr_cache;
90static struct kmem_cache *mw_cache;
91
5bb7d929
HNN		 92enum ehca_mr_pgsize {
93 EHCA_MR_PGSIZE4K = 0x1000L,
94 EHCA_MR_PGSIZE64K = 0x10000L,
95 EHCA_MR_PGSIZE1M = 0x100000L,
96 EHCA_MR_PGSIZE16M = 0x1000000L
97};
98
3a31c419
JF		 99#define EHCA_MR_PGSHIFT4K 12
100#define EHCA_MR_PGSHIFT64K 16
101#define EHCA_MR_PGSHIFT1M 20
102#define EHCA_MR_PGSHIFT16M 24
103
0cf89dcd
HH		 104static u64 ehca_map_vaddr(void *caddr);
105
5bb7d929
HNN		 106static u32 ehca_encode_hwpage_size(u32 pgsize)
107{
8c08d50d
JF		 108 int log = ilog2(pgsize);
109 WARN_ON(log < 12 || log > 24 || log & 3);
110 return (log - 12) / 4;
5bb7d929
HNN		 111}
112
113static u64 ehca_get_max_hwpage_size(struct ehca_shca *shca)
114{
abc39d36 115 return 1UL << ilog2(shca->hca_cap_mr_pgsize);
5bb7d929
HNN		 116}
117
fab97220
HS		 118static struct ehca_mr *ehca_mr_new(void)
119{
120 struct ehca_mr *me;
121
c3762229 122 me = kmem_cache_zalloc(mr_cache, GFP_KERNEL);
2b94397a 123 if (me)
fab97220 124 spin_lock_init(&me->mrlock);
2b94397a 125 else
fab97220
HS		 126 ehca_gen_err("alloc failed");
127
128 return me;
129}
130
131static void ehca_mr_delete(struct ehca_mr *me)
132{
133 kmem_cache_free(mr_cache, me);
134}
135
136static struct ehca_mw *ehca_mw_new(void)
137{
138 struct ehca_mw *me;
139
c3762229 140 me = kmem_cache_zalloc(mw_cache, GFP_KERNEL);
2b94397a 141 if (me)
fab97220 142 spin_lock_init(&me->mwlock);
2b94397a 143 else
fab97220
HS		 144 ehca_gen_err("alloc failed");
145
146 return me;
147}
148
149static void ehca_mw_delete(struct ehca_mw *me)
150{
151 kmem_cache_free(mw_cache, me);
152}
153
154/*----------------------------------------------------------------------*/
155
156struct ib_mr *ehca_get_dma_mr(struct ib_pd *pd, int mr_access_flags)
157{
158 struct ib_mr *ib_mr;
159 int ret;
160 struct ehca_mr *e_maxmr;
161 struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd);
162 struct ehca_shca *shca =
163 container_of(pd->device, struct ehca_shca, ib_device);
164
165 if (shca->maxmr) {
166 e_maxmr = ehca_mr_new();
167 if (!e_maxmr) {
168 ehca_err(&shca->ib_device, "out of memory");
169 ib_mr = ERR_PTR(-ENOMEM);
170 goto get_dma_mr_exit0;
171 }
172
0cf89dcd
HH		 173 ret = ehca_reg_maxmr(shca, e_maxmr,
174 (void *)ehca_map_vaddr((void *)KERNELBASE),
fab97220
HS		 175 mr_access_flags, e_pd,
176 &e_maxmr->ib.ib_mr.lkey,
177 &e_maxmr->ib.ib_mr.rkey);
178 if (ret) {
3df78f81 179 ehca_mr_delete(e_maxmr);
fab97220
HS		 180 ib_mr = ERR_PTR(ret);
181 goto get_dma_mr_exit0;
182 }
183 ib_mr = &e_maxmr->ib.ib_mr;
184 } else {
185 ehca_err(&shca->ib_device, "no internal max-MR exist!");
186 ib_mr = ERR_PTR(-EINVAL);
187 goto get_dma_mr_exit0;
188 }
189
190get_dma_mr_exit0:
191 if (IS_ERR(ib_mr))
e3722192 192 ehca_err(&shca->ib_device, "h_ret=%li pd=%p mr_access_flags=%x",
fab97220
HS		 193 PTR_ERR(ib_mr), pd, mr_access_flags);
194 return ib_mr;
195} /* end ehca_get_dma_mr() */
196
197/*----------------------------------------------------------------------*/
198
199struct ib_mr *ehca_reg_phys_mr(struct ib_pd *pd,
200 struct ib_phys_buf *phys_buf_array,
201 int num_phys_buf,
202 int mr_access_flags,
203 u64 *iova_start)
204{
205 struct ib_mr *ib_mr;
206 int ret;
207 struct ehca_mr *e_mr;
208 struct ehca_shca *shca =
209 container_of(pd->device, struct ehca_shca, ib_device);
210 struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd);
211
212 u64 size;
fab97220
HS		 213
214 if ((num_phys_buf <= 0) || !phys_buf_array) {
215 ehca_err(pd->device, "bad input values: num_phys_buf=%x "
216 "phys_buf_array=%p", num_phys_buf, phys_buf_array);
217 ib_mr = ERR_PTR(-EINVAL);
218 goto reg_phys_mr_exit0;
219 }
220 if (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) &&
221 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) ||
222 ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) &&
223 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE))) {
224 /*
225 * Remote Write Access requires Local Write Access
226 * Remote Atomic Access requires Local Write Access
227 */
228 ehca_err(pd->device, "bad input values: mr_access_flags=%x",
229 mr_access_flags);
230 ib_mr = ERR_PTR(-EINVAL);
231 goto reg_phys_mr_exit0;
232 }
233
234 /* check physical buffer list and calculate size */
235 ret = ehca_mr_chk_buf_and_calc_size(phys_buf_array, num_phys_buf,
236 iova_start, &size);
237 if (ret) {
238 ib_mr = ERR_PTR(ret);
239 goto reg_phys_mr_exit0;
240 }
241 if ((size == 0) ||
242 (((u64)iova_start + size) < (u64)iova_start)) {
3750f605 243 ehca_err(pd->device, "bad input values: size=%llx iova_start=%p",
fab97220
HS		 244 size, iova_start);
245 ib_mr = ERR_PTR(-EINVAL);
246 goto reg_phys_mr_exit0;
247 }
248
249 e_mr = ehca_mr_new();
250 if (!e_mr) {
251 ehca_err(pd->device, "out of memory");
252 ib_mr = ERR_PTR(-ENOMEM);
253 goto reg_phys_mr_exit0;
254 }
255
fab97220
HS		 256 /* register MR on HCA */
257 if (ehca_mr_is_maxmr(size, iova_start)) {
258 e_mr->flags |= EHCA_MR_FLAG_MAXMR;
259 ret = ehca_reg_maxmr(shca, e_mr, iova_start, mr_access_flags,
260 e_pd, &e_mr->ib.ib_mr.lkey,
261 &e_mr->ib.ib_mr.rkey);
262 if (ret) {
263 ib_mr = ERR_PTR(ret);
264 goto reg_phys_mr_exit1;
265 }
266 } else {
df17bfd4
HNN		 267 struct ehca_mr_pginfo pginfo;
268 u32 num_kpages;
269 u32 num_hwpages;
5bb7d929 270 u64 hw_pgsize;
df17bfd4
HNN		 271
272 num_kpages = NUM_CHUNKS(((u64)iova_start % PAGE_SIZE) + size,
273 PAGE_SIZE);
5bb7d929
HNN		 274 /* for kernel space we try most possible pgsize */
275 hw_pgsize = ehca_get_max_hwpage_size(shca);
276 num_hwpages = NUM_CHUNKS(((u64)iova_start % hw_pgsize) + size,
277 hw_pgsize);
df17bfd4
HNN		 278 memset(&pginfo, 0, sizeof(pginfo));
279 pginfo.type = EHCA_MR_PGI_PHYS;
280 pginfo.num_kpages = num_kpages;
5bb7d929 281 pginfo.hwpage_size = hw_pgsize;
df17bfd4
HNN		 282 pginfo.num_hwpages = num_hwpages;
283 pginfo.u.phy.num_phys_buf = num_phys_buf;
284 pginfo.u.phy.phys_buf_array = phys_buf_array;
5bb7d929 285 pginfo.next_hwpage =
9511724d 286 ((u64)iova_start & ~PAGE_MASK) / hw_pgsize;
fab97220
HS		 287
288 ret = ehca_reg_mr(shca, e_mr, iova_start, size, mr_access_flags,
289 e_pd, &pginfo, &e_mr->ib.ib_mr.lkey,
0cf89dcd 290 &e_mr->ib.ib_mr.rkey, EHCA_REG_MR);
fab97220
HS		 291 if (ret) {
292 ib_mr = ERR_PTR(ret);
293 goto reg_phys_mr_exit1;
294 }
295 }
296
297 /* successful registration of all pages */
298 return &e_mr->ib.ib_mr;
299
300reg_phys_mr_exit1:
301 ehca_mr_delete(e_mr);
302reg_phys_mr_exit0:
303 if (IS_ERR(ib_mr))
e3722192 304 ehca_err(pd->device, "h_ret=%li pd=%p phys_buf_array=%p "
fab97220
HS		 305 "num_phys_buf=%x mr_access_flags=%x iova_start=%p",
306 PTR_ERR(ib_mr), pd, phys_buf_array,
307 num_phys_buf, mr_access_flags, iova_start);
308 return ib_mr;
309} /* end ehca_reg_phys_mr() */
310
311/*----------------------------------------------------------------------*/
312
2b94397a
HNN		 313struct ib_mr *ehca_reg_user_mr(struct ib_pd *pd, u64 start, u64 length,
314 u64 virt, int mr_access_flags,
315 struct ib_udata *udata)
fab97220
HS		 316{
317 struct ib_mr *ib_mr;
318 struct ehca_mr *e_mr;
319 struct ehca_shca *shca =
320 container_of(pd->device, struct ehca_shca, ib_device);
321 struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd);
df17bfd4 322 struct ehca_mr_pginfo pginfo;
abc39d36 323 int ret, page_shift;
df17bfd4
HNN		 324 u32 num_kpages;
325 u32 num_hwpages;
5bb7d929 326 u64 hwpage_size;
fab97220
HS		 327
328 if (!pd) {
329 ehca_gen_err("bad pd=%p", pd);
330 return ERR_PTR(-EFAULT);
331 }
f7c6a7b5 332
fab97220
HS		 333 if (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) &&
334 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) ||
335 ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) &&
336 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE))) {
337 /*
338 * Remote Write Access requires Local Write Access
339 * Remote Atomic Access requires Local Write Access
340 */
341 ehca_err(pd->device, "bad input values: mr_access_flags=%x",
342 mr_access_flags);
343 ib_mr = ERR_PTR(-EINVAL);
344 goto reg_user_mr_exit0;
345 }
fab97220 346
f7c6a7b5 347 if (length == 0 || virt + length < virt) {
3750f605
SR		 348 ehca_err(pd->device, "bad input values: length=%llx "
349 "virt_base=%llx", length, virt);
fab97220
HS		 350 ib_mr = ERR_PTR(-EINVAL);
351 goto reg_user_mr_exit0;
352 }
353
354 e_mr = ehca_mr_new();
355 if (!e_mr) {
356 ehca_err(pd->device, "out of memory");
357 ib_mr = ERR_PTR(-ENOMEM);
358 goto reg_user_mr_exit0;
359 }
360
f7c6a7b5 361 e_mr->umem = ib_umem_get(pd->uobject->context, start, length,
cb9fbc5c 362 mr_access_flags, 0);
f7c6a7b5 363 if (IS_ERR(e_mr->umem)) {
2b94397a 364 ib_mr = (void *)e_mr->umem;
f7c6a7b5
RD		 365 goto reg_user_mr_exit1;
366 }
367
368 if (e_mr->umem->page_size != PAGE_SIZE) {
369 ehca_err(pd->device, "page size not supported, "
370 "e_mr->umem->page_size=%x", e_mr->umem->page_size);
371 ib_mr = ERR_PTR(-EINVAL);
372 goto reg_user_mr_exit2;
373 }
374
fab97220 375 /* determine number of MR pages */
df17bfd4 376 num_kpages = NUM_CHUNKS((virt % PAGE_SIZE) + length, PAGE_SIZE);
5bb7d929 377 /* select proper hw_pgsize */
abc39d36
JF		 378 page_shift = PAGE_SHIFT;
379 if (e_mr->umem->hugetlb) {
380 /* determine page_shift, clamp between 4K and 16M */
381 page_shift = (fls64(length - 1) + 3) & ~3;
382 page_shift = min(max(page_shift, EHCA_MR_PGSHIFT4K),
383 EHCA_MR_PGSHIFT16M);
384 }
385 hwpage_size = 1UL << page_shift;
386
387 /* now that we have the desired page size, shift until it's
388 * supported, too. 4K is always supported, so this terminates.
389 */
390 while (!(hwpage_size & shca->hca_cap_mr_pgsize))
391 hwpage_size >>= 4;
fab97220 392
5bb7d929
HNN		 393reg_user_mr_fallback:
394 num_hwpages = NUM_CHUNKS((virt % hwpage_size) + length, hwpage_size);
fab97220 395 /* register MR on HCA */
df17bfd4
HNN		 396 memset(&pginfo, 0, sizeof(pginfo));
397 pginfo.type = EHCA_MR_PGI_USER;
5bb7d929 398 pginfo.hwpage_size = hwpage_size;
df17bfd4
HNN		 399 pginfo.num_kpages = num_kpages;
400 pginfo.num_hwpages = num_hwpages;
401 pginfo.u.usr.region = e_mr->umem;
5bb7d929 402 pginfo.next_hwpage = e_mr->umem->offset / hwpage_size;
df17bfd4
HNN		 403 pginfo.u.usr.next_chunk = list_prepare_entry(pginfo.u.usr.next_chunk,
404 (&e_mr->umem->chunk_list),
405 list);
fab97220 406
2b94397a
HNN		 407 ret = ehca_reg_mr(shca, e_mr, (u64 *)virt, length, mr_access_flags,
408 e_pd, &pginfo, &e_mr->ib.ib_mr.lkey,
0cf89dcd 409 &e_mr->ib.ib_mr.rkey, EHCA_REG_MR);
5bb7d929
HNN		 410 if (ret == -EINVAL && pginfo.hwpage_size > PAGE_SIZE) {
411 ehca_warn(pd->device, "failed to register mr "
3750f605 412 "with hwpage_size=%llx", hwpage_size);
5bb7d929
HNN		 413 ehca_info(pd->device, "try to register mr with "
414 "kpage_size=%lx", PAGE_SIZE);
415 /*
416 * this means kpages are not contiguous for a hw page
417 * try kernel page size as fallback solution
418 */
419 hwpage_size = PAGE_SIZE;
420 goto reg_user_mr_fallback;
421 }
fab97220
HS		 422 if (ret) {
423 ib_mr = ERR_PTR(ret);
f7c6a7b5 424 goto reg_user_mr_exit2;
fab97220
HS		 425 }
426
427 /* successful registration of all pages */
428 return &e_mr->ib.ib_mr;
429
f7c6a7b5
RD		 430reg_user_mr_exit2:
431 ib_umem_release(e_mr->umem);
fab97220
HS		 432reg_user_mr_exit1:
433 ehca_mr_delete(e_mr);
434reg_user_mr_exit0:
435 if (IS_ERR(ib_mr))
e3722192 436 ehca_err(pd->device, "rc=%li pd=%p mr_access_flags=%x udata=%p",
f7c6a7b5 437 PTR_ERR(ib_mr), pd, mr_access_flags, udata);
fab97220
HS		 438 return ib_mr;
439} /* end ehca_reg_user_mr() */
440
441/*----------------------------------------------------------------------*/
442
443int ehca_rereg_phys_mr(struct ib_mr *mr,
444 int mr_rereg_mask,
445 struct ib_pd *pd,
446 struct ib_phys_buf *phys_buf_array,
447 int num_phys_buf,
448 int mr_access_flags,
449 u64 *iova_start)
450{
451 int ret;
452
453 struct ehca_shca *shca =
454 container_of(mr->device, struct ehca_shca, ib_device);
455 struct ehca_mr *e_mr = container_of(mr, struct ehca_mr, ib.ib_mr);
fab97220
HS		 456 u64 new_size;
457 u64 *new_start;
458 u32 new_acl;
459 struct ehca_pd *new_pd;
460 u32 tmp_lkey, tmp_rkey;
461 unsigned long sl_flags;
df17bfd4
HNN		 462 u32 num_kpages = 0;
463 u32 num_hwpages = 0;
464 struct ehca_mr_pginfo pginfo;
fab97220
HS		 465
466 if (!(mr_rereg_mask & IB_MR_REREG_TRANS)) {
467 /* TODO not supported, because PHYP rereg hCall needs pages */
468 ehca_err(mr->device, "rereg without IB_MR_REREG_TRANS not "
469 "supported yet, mr_rereg_mask=%x", mr_rereg_mask);
470 ret = -EINVAL;
471 goto rereg_phys_mr_exit0;
472 }
473
474 if (mr_rereg_mask & IB_MR_REREG_PD) {
475 if (!pd) {
476 ehca_err(mr->device, "rereg with bad pd, pd=%p "
477 "mr_rereg_mask=%x", pd, mr_rereg_mask);
478 ret = -EINVAL;
479 goto rereg_phys_mr_exit0;
480 }
481 }
482
483 if ((mr_rereg_mask &
484 ~(IB_MR_REREG_TRANS | IB_MR_REREG_PD | IB_MR_REREG_ACCESS)) ||
485 (mr_rereg_mask == 0)) {
486 ret = -EINVAL;
487 goto rereg_phys_mr_exit0;
488 }
489
490 /* check other parameters */
491 if (e_mr == shca->maxmr) {
492 /* should be impossible, however reject to be sure */
493 ehca_err(mr->device, "rereg internal max-MR impossible, mr=%p "
494 "shca->maxmr=%p mr->lkey=%x",
495 mr, shca->maxmr, mr->lkey);
496 ret = -EINVAL;
497 goto rereg_phys_mr_exit0;
498 }
499 if (mr_rereg_mask & IB_MR_REREG_TRANS) { /* transl., i.e. addr/size */
500 if (e_mr->flags & EHCA_MR_FLAG_FMR) {
501 ehca_err(mr->device, "not supported for FMR, mr=%p "
502 "flags=%x", mr, e_mr->flags);
503 ret = -EINVAL;
504 goto rereg_phys_mr_exit0;
505 }
506 if (!phys_buf_array || num_phys_buf <= 0) {
2b94397a 507 ehca_err(mr->device, "bad input values mr_rereg_mask=%x"
fab97220
HS		 508 " phys_buf_array=%p num_phys_buf=%x",
509 mr_rereg_mask, phys_buf_array, num_phys_buf);
510 ret = -EINVAL;
511 goto rereg_phys_mr_exit0;
512 }
513 }
514 if ((mr_rereg_mask & IB_MR_REREG_ACCESS) && /* change ACL */
515 (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) &&
516 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) ||
517 ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) &&
518 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)))) {
519 /*
520 * Remote Write Access requires Local Write Access
521 * Remote Atomic Access requires Local Write Access
522 */
523 ehca_err(mr->device, "bad input values: mr_rereg_mask=%x "
524 "mr_access_flags=%x", mr_rereg_mask, mr_access_flags);
525 ret = -EINVAL;
526 goto rereg_phys_mr_exit0;
527 }
528
529 /* set requested values dependent on rereg request */
530 spin_lock_irqsave(&e_mr->mrlock, sl_flags);
2b94397a
HNN		 531 new_start = e_mr->start;
532 new_size = e_mr->size;
533 new_acl = e_mr->acl;
534 new_pd = container_of(mr->pd, struct ehca_pd, ib_pd);
fab97220
HS		 535
536 if (mr_rereg_mask & IB_MR_REREG_TRANS) {
5bb7d929
HNN		 537 u64 hw_pgsize = ehca_get_max_hwpage_size(shca);
538
fab97220
HS		 539 new_start = iova_start; /* change address */
540 /* check physical buffer list and calculate size */
541 ret = ehca_mr_chk_buf_and_calc_size(phys_buf_array,
542 num_phys_buf, iova_start,
543 &new_size);
544 if (ret)
545 goto rereg_phys_mr_exit1;
546 if ((new_size == 0) ||
547 (((u64)iova_start + new_size) < (u64)iova_start)) {
3750f605 548 ehca_err(mr->device, "bad input values: new_size=%llx "
fab97220
HS		 549 "iova_start=%p", new_size, iova_start);
550 ret = -EINVAL;
551 goto rereg_phys_mr_exit1;
552 }
df17bfd4
HNN		 553 num_kpages = NUM_CHUNKS(((u64)new_start % PAGE_SIZE) +
554 new_size, PAGE_SIZE);
5bb7d929
HNN		 555 num_hwpages = NUM_CHUNKS(((u64)new_start % hw_pgsize) +
556 new_size, hw_pgsize);
df17bfd4
HNN		 557 memset(&pginfo, 0, sizeof(pginfo));
558 pginfo.type = EHCA_MR_PGI_PHYS;
559 pginfo.num_kpages = num_kpages;
5bb7d929 560 pginfo.hwpage_size = hw_pgsize;
df17bfd4
HNN		 561 pginfo.num_hwpages = num_hwpages;
562 pginfo.u.phy.num_phys_buf = num_phys_buf;
563 pginfo.u.phy.phys_buf_array = phys_buf_array;
5bb7d929 564 pginfo.next_hwpage =
9511724d 565 ((u64)iova_start & ~PAGE_MASK) / hw_pgsize;
fab97220
HS		 566 }
567 if (mr_rereg_mask & IB_MR_REREG_ACCESS)
568 new_acl = mr_access_flags;
569 if (mr_rereg_mask & IB_MR_REREG_PD)
570 new_pd = container_of(pd, struct ehca_pd, ib_pd);
571
572 ret = ehca_rereg_mr(shca, e_mr, new_start, new_size, new_acl,
573 new_pd, &pginfo, &tmp_lkey, &tmp_rkey);
574 if (ret)
575 goto rereg_phys_mr_exit1;
576
577 /* successful reregistration */
578 if (mr_rereg_mask & IB_MR_REREG_PD)
579 mr->pd = pd;
580 mr->lkey = tmp_lkey;
581 mr->rkey = tmp_rkey;
582
583rereg_phys_mr_exit1:
584 spin_unlock_irqrestore(&e_mr->mrlock, sl_flags);
585rereg_phys_mr_exit0:
586 if (ret)
e3722192 587 ehca_err(mr->device, "ret=%i mr=%p mr_rereg_mask=%x pd=%p "
fab97220
HS		 588 "phys_buf_array=%p num_phys_buf=%x mr_access_flags=%x "
589 "iova_start=%p",
590 ret, mr, mr_rereg_mask, pd, phys_buf_array,
591 num_phys_buf, mr_access_flags, iova_start);
592 return ret;
593} /* end ehca_rereg_phys_mr() */
594
595/*----------------------------------------------------------------------*/
596
597int ehca_query_mr(struct ib_mr *mr, struct ib_mr_attr *mr_attr)
598{
599 int ret = 0;
600 u64 h_ret;
601 struct ehca_shca *shca =
602 container_of(mr->device, struct ehca_shca, ib_device);
603 struct ehca_mr *e_mr = container_of(mr, struct ehca_mr, ib.ib_mr);
fab97220 604 unsigned long sl_flags;
2b94397a 605 struct ehca_mr_hipzout_parms hipzout;
fab97220 606
fab97220
HS		 607 if ((e_mr->flags & EHCA_MR_FLAG_FMR)) {
608 ehca_err(mr->device, "not supported for FMR, mr=%p e_mr=%p "
609 "e_mr->flags=%x", mr, e_mr, e_mr->flags);
610 ret = -EINVAL;
611 goto query_mr_exit0;
612 }
613
614 memset(mr_attr, 0, sizeof(struct ib_mr_attr));
615 spin_lock_irqsave(&e_mr->mrlock, sl_flags);
616
617 h_ret = hipz_h_query_mr(shca->ipz_hca_handle, e_mr, &hipzout);
618 if (h_ret != H_SUCCESS) {
3750f605
SR		 619 ehca_err(mr->device, "hipz_mr_query failed, h_ret=%lli mr=%p "
620 "hca_hndl=%llx mr_hndl=%llx lkey=%x",
fab97220
HS		 621 h_ret, mr, shca->ipz_hca_handle.handle,
622 e_mr->ipz_mr_handle.handle, mr->lkey);
a1a6ff11 623 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 624 goto query_mr_exit1;
625 }
df17bfd4 626 mr_attr->pd = mr->pd;
fab97220 627 mr_attr->device_virt_addr = hipzout.vaddr;
df17bfd4
HNN		 628 mr_attr->size = hipzout.len;
629 mr_attr->lkey = hipzout.lkey;
630 mr_attr->rkey = hipzout.rkey;
fab97220
HS		 631 ehca_mrmw_reverse_map_acl(&hipzout.acl, &mr_attr->mr_access_flags);
632
633query_mr_exit1:
634 spin_unlock_irqrestore(&e_mr->mrlock, sl_flags);
635query_mr_exit0:
636 if (ret)
e3722192 637 ehca_err(mr->device, "ret=%i mr=%p mr_attr=%p",
fab97220
HS		 638 ret, mr, mr_attr);
639 return ret;
640} /* end ehca_query_mr() */
641
642/*----------------------------------------------------------------------*/
643
644int ehca_dereg_mr(struct ib_mr *mr)
645{
646 int ret = 0;
647 u64 h_ret;
648 struct ehca_shca *shca =
649 container_of(mr->device, struct ehca_shca, ib_device);
650 struct ehca_mr *e_mr = container_of(mr, struct ehca_mr, ib.ib_mr);
fab97220
HS		 651
652 if ((e_mr->flags & EHCA_MR_FLAG_FMR)) {
653 ehca_err(mr->device, "not supported for FMR, mr=%p e_mr=%p "
654 "e_mr->flags=%x", mr, e_mr, e_mr->flags);
655 ret = -EINVAL;
656 goto dereg_mr_exit0;
657 } else if (e_mr == shca->maxmr) {
658 /* should be impossible, however reject to be sure */
659 ehca_err(mr->device, "dereg internal max-MR impossible, mr=%p "
660 "shca->maxmr=%p mr->lkey=%x",
661 mr, shca->maxmr, mr->lkey);
662 ret = -EINVAL;
663 goto dereg_mr_exit0;
664 }
665
666 /* TODO: BUSY: MR still has bound window(s) */
667 h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_mr);
668 if (h_ret != H_SUCCESS) {
3750f605
SR		 669 ehca_err(mr->device, "hipz_free_mr failed, h_ret=%lli shca=%p "
670 "e_mr=%p hca_hndl=%llx mr_hndl=%llx mr->lkey=%x",
fab97220
HS		 671 h_ret, shca, e_mr, shca->ipz_hca_handle.handle,
672 e_mr->ipz_mr_handle.handle, mr->lkey);
a1a6ff11 673 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 674 goto dereg_mr_exit0;
675 }
676
f7c6a7b5
RD		 677 if (e_mr->umem)
678 ib_umem_release(e_mr->umem);
679
fab97220
HS		 680 /* successful deregistration */
681 ehca_mr_delete(e_mr);
682
683dereg_mr_exit0:
684 if (ret)
e3722192 685 ehca_err(mr->device, "ret=%i mr=%p", ret, mr);
fab97220
HS		 686 return ret;
687} /* end ehca_dereg_mr() */
688
689/*----------------------------------------------------------------------*/
690
691struct ib_mw *ehca_alloc_mw(struct ib_pd *pd)
692{
693 struct ib_mw *ib_mw;
694 u64 h_ret;
695 struct ehca_mw *e_mw;
696 struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd);
697 struct ehca_shca *shca =
698 container_of(pd->device, struct ehca_shca, ib_device);
2b94397a 699 struct ehca_mw_hipzout_parms hipzout;
fab97220
HS		 700
701 e_mw = ehca_mw_new();
702 if (!e_mw) {
703 ib_mw = ERR_PTR(-ENOMEM);
704 goto alloc_mw_exit0;
705 }
706
707 h_ret = hipz_h_alloc_resource_mw(shca->ipz_hca_handle, e_mw,
708 e_pd->fw_pd, &hipzout);
709 if (h_ret != H_SUCCESS) {
3750f605
SR		 710 ehca_err(pd->device, "hipz_mw_allocate failed, h_ret=%lli "
711 "shca=%p hca_hndl=%llx mw=%p",
fab97220 712 h_ret, shca, shca->ipz_hca_handle.handle, e_mw);
a1a6ff11 713 ib_mw = ERR_PTR(ehca2ib_return_code(h_ret));
fab97220
HS		 714 goto alloc_mw_exit1;
715 }
716 /* successful MW allocation */
717 e_mw->ipz_mw_handle = hipzout.handle;
718 e_mw->ib_mw.rkey = hipzout.rkey;
719 return &e_mw->ib_mw;
720
721alloc_mw_exit1:
722 ehca_mw_delete(e_mw);
723alloc_mw_exit0:
724 if (IS_ERR(ib_mw))
e3722192 725 ehca_err(pd->device, "h_ret=%li pd=%p", PTR_ERR(ib_mw), pd);
fab97220
HS		 726 return ib_mw;
727} /* end ehca_alloc_mw() */
728
729/*----------------------------------------------------------------------*/
730
731int ehca_bind_mw(struct ib_qp *qp,
732 struct ib_mw *mw,
733 struct ib_mw_bind *mw_bind)
734{
735 /* TODO: not supported up to now */
736 ehca_gen_err("bind MW currently not supported by HCAD");
737
738 return -EPERM;
739} /* end ehca_bind_mw() */
740
741/*----------------------------------------------------------------------*/
742
743int ehca_dealloc_mw(struct ib_mw *mw)
744{
745 u64 h_ret;
746 struct ehca_shca *shca =
747 container_of(mw->device, struct ehca_shca, ib_device);
748 struct ehca_mw *e_mw = container_of(mw, struct ehca_mw, ib_mw);
749
750 h_ret = hipz_h_free_resource_mw(shca->ipz_hca_handle, e_mw);
751 if (h_ret != H_SUCCESS) {
3750f605
SR		 752 ehca_err(mw->device, "hipz_free_mw failed, h_ret=%lli shca=%p "
753 "mw=%p rkey=%x hca_hndl=%llx mw_hndl=%llx",
fab97220
HS		 754 h_ret, shca, mw, mw->rkey, shca->ipz_hca_handle.handle,
755 e_mw->ipz_mw_handle.handle);
a1a6ff11 756 return ehca2ib_return_code(h_ret);
fab97220
HS		 757 }
758 /* successful deallocation */
759 ehca_mw_delete(e_mw);
760 return 0;
761} /* end ehca_dealloc_mw() */
762
763/*----------------------------------------------------------------------*/
764
765struct ib_fmr *ehca_alloc_fmr(struct ib_pd *pd,
766 int mr_access_flags,
767 struct ib_fmr_attr *fmr_attr)
768{
769 struct ib_fmr *ib_fmr;
770 struct ehca_shca *shca =
771 container_of(pd->device, struct ehca_shca, ib_device);
772 struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd);
773 struct ehca_mr *e_fmr;
774 int ret;
775 u32 tmp_lkey, tmp_rkey;
df17bfd4 776 struct ehca_mr_pginfo pginfo;
5bb7d929 777 u64 hw_pgsize;
fab97220
HS		 778
779 /* check other parameters */
780 if (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) &&
781 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) ||
782 ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) &&
783 !(mr_access_flags & IB_ACCESS_LOCAL_WRITE))) {
784 /*
785 * Remote Write Access requires Local Write Access
786 * Remote Atomic Access requires Local Write Access
787 */
788 ehca_err(pd->device, "bad input values: mr_access_flags=%x",
789 mr_access_flags);
790 ib_fmr = ERR_PTR(-EINVAL);
791 goto alloc_fmr_exit0;
792 }
793 if (mr_access_flags & IB_ACCESS_MW_BIND) {
794 ehca_err(pd->device, "bad input values: mr_access_flags=%x",
795 mr_access_flags);
796 ib_fmr = ERR_PTR(-EINVAL);
797 goto alloc_fmr_exit0;
798 }
799 if ((fmr_attr->max_pages == 0) || (fmr_attr->max_maps == 0)) {
800 ehca_err(pd->device, "bad input values: fmr_attr->max_pages=%x "
801 "fmr_attr->max_maps=%x fmr_attr->page_shift=%x",
802 fmr_attr->max_pages, fmr_attr->max_maps,
803 fmr_attr->page_shift);
804 ib_fmr = ERR_PTR(-EINVAL);
805 goto alloc_fmr_exit0;
806 }
abc39d36
JF		 807
808 hw_pgsize = 1 << fmr_attr->page_shift;
809 if (!(hw_pgsize & shca->hca_cap_mr_pgsize)) {
fab97220
HS		 810 ehca_err(pd->device, "unsupported fmr_attr->page_shift=%x",
811 fmr_attr->page_shift);
812 ib_fmr = ERR_PTR(-EINVAL);
813 goto alloc_fmr_exit0;
814 }
815
816 e_fmr = ehca_mr_new();
817 if (!e_fmr) {
818 ib_fmr = ERR_PTR(-ENOMEM);
819 goto alloc_fmr_exit0;
820 }
821 e_fmr->flags |= EHCA_MR_FLAG_FMR;
822
823 /* register MR on HCA */
df17bfd4 824 memset(&pginfo, 0, sizeof(pginfo));
8c08d50d 825 pginfo.hwpage_size = hw_pgsize;
5bb7d929
HNN		 826 /*
827 * pginfo.num_hwpages==0, ie register_rpages() will not be called
828 * but deferred to map_phys_fmr()
829 */
fab97220
HS		 830 ret = ehca_reg_mr(shca, e_fmr, NULL,
831 fmr_attr->max_pages * (1 << fmr_attr->page_shift),
832 mr_access_flags, e_pd, &pginfo,
0cf89dcd 833 &tmp_lkey, &tmp_rkey, EHCA_REG_MR);
fab97220
HS		 834 if (ret) {
835 ib_fmr = ERR_PTR(ret);
836 goto alloc_fmr_exit1;
837 }
838
839 /* successful */
5bb7d929 840 e_fmr->hwpage_size = hw_pgsize;
fab97220
HS		 841 e_fmr->fmr_page_size = 1 << fmr_attr->page_shift;
842 e_fmr->fmr_max_pages = fmr_attr->max_pages;
843 e_fmr->fmr_max_maps = fmr_attr->max_maps;
844 e_fmr->fmr_map_cnt = 0;
845 return &e_fmr->ib.ib_fmr;
846
847alloc_fmr_exit1:
848 ehca_mr_delete(e_fmr);
849alloc_fmr_exit0:
fab97220
HS		 850 return ib_fmr;
851} /* end ehca_alloc_fmr() */
852
853/*----------------------------------------------------------------------*/
854
855int ehca_map_phys_fmr(struct ib_fmr *fmr,
856 u64 *page_list,
857 int list_len,
858 u64 iova)
859{
860 int ret;
861 struct ehca_shca *shca =
862 container_of(fmr->device, struct ehca_shca, ib_device);
863 struct ehca_mr *e_fmr = container_of(fmr, struct ehca_mr, ib.ib_fmr);
864 struct ehca_pd *e_pd = container_of(fmr->pd, struct ehca_pd, ib_pd);
df17bfd4 865 struct ehca_mr_pginfo pginfo;
fab97220
HS		 866 u32 tmp_lkey, tmp_rkey;
867
868 if (!(e_fmr->flags & EHCA_MR_FLAG_FMR)) {
869 ehca_err(fmr->device, "not a FMR, e_fmr=%p e_fmr->flags=%x",
870 e_fmr, e_fmr->flags);
871 ret = -EINVAL;
872 goto map_phys_fmr_exit0;
873 }
874 ret = ehca_fmr_check_page_list(e_fmr, page_list, list_len);
875 if (ret)
876 goto map_phys_fmr_exit0;
877 if (iova % e_fmr->fmr_page_size) {
878 /* only whole-numbered pages */
3750f605 879 ehca_err(fmr->device, "bad iova, iova=%llx fmr_page_size=%x",
fab97220
HS		 880 iova, e_fmr->fmr_page_size);
881 ret = -EINVAL;
882 goto map_phys_fmr_exit0;
883 }
884 if (e_fmr->fmr_map_cnt >= e_fmr->fmr_max_maps) {
885 /* HCAD does not limit the maps, however trace this anyway */
886 ehca_info(fmr->device, "map limit exceeded, fmr=%p "
887 "e_fmr->fmr_map_cnt=%x e_fmr->fmr_max_maps=%x",
888 fmr, e_fmr->fmr_map_cnt, e_fmr->fmr_max_maps);
889 }
890
df17bfd4
HNN		 891 memset(&pginfo, 0, sizeof(pginfo));
892 pginfo.type = EHCA_MR_PGI_FMR;
893 pginfo.num_kpages = list_len;
5bb7d929
HNN		 894 pginfo.hwpage_size = e_fmr->hwpage_size;
895 pginfo.num_hwpages =
896 list_len * e_fmr->fmr_page_size / pginfo.hwpage_size;
df17bfd4 897 pginfo.u.fmr.page_list = page_list;
5bb7d929
HNN		 898 pginfo.next_hwpage =
899 (iova & (e_fmr->fmr_page_size-1)) / pginfo.hwpage_size;
187c72e3 900 pginfo.u.fmr.fmr_pgsize = e_fmr->fmr_page_size;
fab97220 901
2b94397a 902 ret = ehca_rereg_mr(shca, e_fmr, (u64 *)iova,
fab97220
HS		 903 list_len * e_fmr->fmr_page_size,
904 e_fmr->acl, e_pd, &pginfo, &tmp_lkey, &tmp_rkey);
905 if (ret)
906 goto map_phys_fmr_exit0;
907
908 /* successful reregistration */
909 e_fmr->fmr_map_cnt++;
910 e_fmr->ib.ib_fmr.lkey = tmp_lkey;
911 e_fmr->ib.ib_fmr.rkey = tmp_rkey;
912 return 0;
913
914map_phys_fmr_exit0:
915 if (ret)
e3722192 916 ehca_err(fmr->device, "ret=%i fmr=%p page_list=%p list_len=%x "
3750f605 917 "iova=%llx", ret, fmr, page_list, list_len, iova);
fab97220
HS		 918 return ret;
919} /* end ehca_map_phys_fmr() */
920
921/*----------------------------------------------------------------------*/
922
923int ehca_unmap_fmr(struct list_head *fmr_list)
924{
925 int ret = 0;
926 struct ib_fmr *ib_fmr;
927 struct ehca_shca *shca = NULL;
928 struct ehca_shca *prev_shca;
929 struct ehca_mr *e_fmr;
930 u32 num_fmr = 0;
931 u32 unmap_fmr_cnt = 0;
932
933 /* check all FMR belong to same SHCA, and check internal flag */
934 list_for_each_entry(ib_fmr, fmr_list, list) {
935 prev_shca = shca;
936 if (!ib_fmr) {
937 ehca_gen_err("bad fmr=%p in list", ib_fmr);
938 ret = -EINVAL;
939 goto unmap_fmr_exit0;
940 }
941 shca = container_of(ib_fmr->device, struct ehca_shca,
942 ib_device);
943 e_fmr = container_of(ib_fmr, struct ehca_mr, ib.ib_fmr);
944 if ((shca != prev_shca) && prev_shca) {
945 ehca_err(&shca->ib_device, "SHCA mismatch, shca=%p "
946 "prev_shca=%p e_fmr=%p",
947 shca, prev_shca, e_fmr);
948 ret = -EINVAL;
949 goto unmap_fmr_exit0;
950 }
951 if (!(e_fmr->flags & EHCA_MR_FLAG_FMR)) {
952 ehca_err(&shca->ib_device, "not a FMR, e_fmr=%p "
953 "e_fmr->flags=%x", e_fmr, e_fmr->flags);
954 ret = -EINVAL;
955 goto unmap_fmr_exit0;
956 }
957 num_fmr++;
958 }
959
960 /* loop over all FMRs to unmap */
961 list_for_each_entry(ib_fmr, fmr_list, list) {
962 unmap_fmr_cnt++;
963 e_fmr = container_of(ib_fmr, struct ehca_mr, ib.ib_fmr);
964 shca = container_of(ib_fmr->device, struct ehca_shca,
965 ib_device);
966 ret = ehca_unmap_one_fmr(shca, e_fmr);
967 if (ret) {
968 /* unmap failed, stop unmapping of rest of FMRs */
969 ehca_err(&shca->ib_device, "unmap of one FMR failed, "
970 "stop rest, e_fmr=%p num_fmr=%x "
971 "unmap_fmr_cnt=%x lkey=%x", e_fmr, num_fmr,
972 unmap_fmr_cnt, e_fmr->ib.ib_fmr.lkey);
973 goto unmap_fmr_exit0;
974 }
975 }
976
977unmap_fmr_exit0:
978 if (ret)
e3722192 979 ehca_gen_err("ret=%i fmr_list=%p num_fmr=%x unmap_fmr_cnt=%x",
fab97220
HS		 980 ret, fmr_list, num_fmr, unmap_fmr_cnt);
981 return ret;
982} /* end ehca_unmap_fmr() */
983
984/*----------------------------------------------------------------------*/
985
986int ehca_dealloc_fmr(struct ib_fmr *fmr)
987{
988 int ret;
989 u64 h_ret;
990 struct ehca_shca *shca =
991 container_of(fmr->device, struct ehca_shca, ib_device);
992 struct ehca_mr *e_fmr = container_of(fmr, struct ehca_mr, ib.ib_fmr);
993
994 if (!(e_fmr->flags & EHCA_MR_FLAG_FMR)) {
995 ehca_err(fmr->device, "not a FMR, e_fmr=%p e_fmr->flags=%x",
996 e_fmr, e_fmr->flags);
997 ret = -EINVAL;
998 goto free_fmr_exit0;
999 }
1000
1001 h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_fmr);
1002 if (h_ret != H_SUCCESS) {
3750f605
SR		 1003 ehca_err(fmr->device, "hipz_free_mr failed, h_ret=%lli e_fmr=%p "
1004 "hca_hndl=%llx fmr_hndl=%llx fmr->lkey=%x",
fab97220
HS		 1005 h_ret, e_fmr, shca->ipz_hca_handle.handle,
1006 e_fmr->ipz_mr_handle.handle, fmr->lkey);
a1a6ff11 1007 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 1008 goto free_fmr_exit0;
1009 }
1010 /* successful deregistration */
1011 ehca_mr_delete(e_fmr);
1012 return 0;
1013
1014free_fmr_exit0:
1015 if (ret)
e3722192 1016 ehca_err(&shca->ib_device, "ret=%i fmr=%p", ret, fmr);
fab97220
HS		 1017 return ret;
1018} /* end ehca_dealloc_fmr() */
1019
1020/*----------------------------------------------------------------------*/
1021
0cf89dcd
HH		 1022static int ehca_reg_bmap_mr_rpages(struct ehca_shca *shca,
1023 struct ehca_mr *e_mr,
1024 struct ehca_mr_pginfo *pginfo);
1025
fab97220
HS		 1026int ehca_reg_mr(struct ehca_shca *shca,
1027 struct ehca_mr *e_mr,
1028 u64 *iova_start,
1029 u64 size,
1030 int acl,
1031 struct ehca_pd *e_pd,
1032 struct ehca_mr_pginfo *pginfo,
1033 u32 *lkey, /*OUT*/
0cf89dcd
HH		 1034 u32 *rkey, /*OUT*/
1035 enum ehca_reg_type reg_type)
fab97220
HS		 1036{
1037 int ret;
1038 u64 h_ret;
1039 u32 hipz_acl;
2b94397a 1040 struct ehca_mr_hipzout_parms hipzout;
fab97220
HS		 1041
1042 ehca_mrmw_map_acl(acl, &hipz_acl);
5bb7d929 1043 ehca_mrmw_set_pgsize_hipz_acl(pginfo->hwpage_size, &hipz_acl);
fab97220 1044 if (ehca_use_hp_mr == 1)
2b94397a 1045 hipz_acl |= 0x00000001;
fab97220
HS		 1046
1047 h_ret = hipz_h_alloc_resource_mr(shca->ipz_hca_handle, e_mr,
1048 (u64)iova_start, size, hipz_acl,
1049 e_pd->fw_pd, &hipzout);
1050 if (h_ret != H_SUCCESS) {
3750f605
SR		 1051 ehca_err(&shca->ib_device, "hipz_alloc_mr failed, h_ret=%lli "
1052 "hca_hndl=%llx", h_ret, shca->ipz_hca_handle.handle);
a1a6ff11 1053 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 1054 goto ehca_reg_mr_exit0;
1055 }
1056
1057 e_mr->ipz_mr_handle = hipzout.handle;
1058
0cf89dcd
HH		 1059 if (reg_type == EHCA_REG_BUSMAP_MR)
1060 ret = ehca_reg_bmap_mr_rpages(shca, e_mr, pginfo);
1061 else if (reg_type == EHCA_REG_MR)
1062 ret = ehca_reg_mr_rpages(shca, e_mr, pginfo);
1063 else
1064 ret = -EINVAL;
1065
fab97220
HS		 1066 if (ret)
1067 goto ehca_reg_mr_exit1;
1068
1069 /* successful registration */
df17bfd4
HNN		 1070 e_mr->num_kpages = pginfo->num_kpages;
1071 e_mr->num_hwpages = pginfo->num_hwpages;
5bb7d929 1072 e_mr->hwpage_size = pginfo->hwpage_size;
df17bfd4
HNN		 1073 e_mr->start = iova_start;
1074 e_mr->size = size;
1075 e_mr->acl = acl;
fab97220
HS		 1076 *lkey = hipzout.lkey;
1077 *rkey = hipzout.rkey;
1078 return 0;
1079
1080ehca_reg_mr_exit1:
1081 h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_mr);
1082 if (h_ret != H_SUCCESS) {
3750f605
SR		 1083 ehca_err(&shca->ib_device, "h_ret=%lli shca=%p e_mr=%p "
1084 "iova_start=%p size=%llx acl=%x e_pd=%p lkey=%x "
1085 "pginfo=%p num_kpages=%llx num_hwpages=%llx ret=%i",
fab97220 1086 h_ret, shca, e_mr, iova_start, size, acl, e_pd,
df17bfd4
HNN		 1087 hipzout.lkey, pginfo, pginfo->num_kpages,
1088 pginfo->num_hwpages, ret);
fab97220
HS		 1089 ehca_err(&shca->ib_device, "internal error in ehca_reg_mr, "
1090 "not recoverable");
1091 }
1092ehca_reg_mr_exit0:
1093 if (ret)
e3722192 1094 ehca_err(&shca->ib_device, "ret=%i shca=%p e_mr=%p "
3750f605
SR		 1095 "iova_start=%p size=%llx acl=%x e_pd=%p pginfo=%p "
1096 "num_kpages=%llx num_hwpages=%llx",
fab97220 1097 ret, shca, e_mr, iova_start, size, acl, e_pd, pginfo,
df17bfd4 1098 pginfo->num_kpages, pginfo->num_hwpages);
fab97220
HS		 1099 return ret;
1100} /* end ehca_reg_mr() */
1101
1102/*----------------------------------------------------------------------*/
1103
1104int ehca_reg_mr_rpages(struct ehca_shca *shca,
1105 struct ehca_mr *e_mr,
1106 struct ehca_mr_pginfo *pginfo)
1107{
1108 int ret = 0;
1109 u64 h_ret;
1110 u32 rnum;
1111 u64 rpage;
1112 u32 i;
1113 u64 *kpage;
1114
5bb7d929
HNN		 1115 if (!pginfo->num_hwpages) /* in case of fmr */
1116 return 0;
1117
f2d91361 1118 kpage = ehca_alloc_fw_ctrlblock(GFP_KERNEL);
fab97220
HS		 1119 if (!kpage) {
1120 ehca_err(&shca->ib_device, "kpage alloc failed");
1121 ret = -ENOMEM;
1122 goto ehca_reg_mr_rpages_exit0;
1123 }
1124
5bb7d929 1125 /* max MAX_RPAGES ehca mr pages per register call */
df17bfd4 1126 for (i = 0; i < NUM_CHUNKS(pginfo->num_hwpages, MAX_RPAGES); i++) {
fab97220 1127
df17bfd4
HNN		 1128 if (i == NUM_CHUNKS(pginfo->num_hwpages, MAX_RPAGES) - 1) {
1129 rnum = pginfo->num_hwpages % MAX_RPAGES; /* last shot */
fab97220 1130 if (rnum == 0)
4e4e74ca 1131 rnum = MAX_RPAGES; /* last shot is full */
fab97220 1132 } else
4e4e74ca 1133 rnum = MAX_RPAGES;
fab97220 1134
187c72e3
HNN		 1135 ret = ehca_set_pagebuf(pginfo, rnum, kpage);
1136 if (ret) {
1137 ehca_err(&shca->ib_device, "ehca_set_pagebuf "
e3722192 1138 "bad rc, ret=%i rnum=%x kpage=%p",
5bb7d929 1139 ret, rnum, kpage);
187c72e3
HNN		 1140 goto ehca_reg_mr_rpages_exit1;
1141 }
1142
1143 if (rnum > 1) {
fab97220
HS		 1144 rpage = virt_to_abs(kpage);
1145 if (!rpage) {
1146 ehca_err(&shca->ib_device, "kpage=%p i=%x",
1147 kpage, i);
1148 ret = -EFAULT;
1149 goto ehca_reg_mr_rpages_exit1;
1150 }
187c72e3
HNN		 1151 } else
1152 rpage = *kpage;
fab97220 1153
5bb7d929
HNN		 1154 h_ret = hipz_h_register_rpage_mr(
1155 shca->ipz_hca_handle, e_mr,
1156 ehca_encode_hwpage_size(pginfo->hwpage_size),
1157 0, rpage, rnum);
fab97220 1158
df17bfd4 1159 if (i == NUM_CHUNKS(pginfo->num_hwpages, MAX_RPAGES) - 1) {
fab97220
HS		 1160 /*
1161 * check for 'registration complete'==H_SUCCESS
1162 * and for 'page registered'==H_PAGE_REGISTERED
1163 */
1164 if (h_ret != H_SUCCESS) {
1165 ehca_err(&shca->ib_device, "last "
3750f605
SR		 1166 "hipz_reg_rpage_mr failed, h_ret=%lli "
1167 "e_mr=%p i=%x hca_hndl=%llx mr_hndl=%llx"
fab97220
HS		 1168 " lkey=%x", h_ret, e_mr, i,
1169 shca->ipz_hca_handle.handle,
1170 e_mr->ipz_mr_handle.handle,
1171 e_mr->ib.ib_mr.lkey);
a1a6ff11 1172 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 1173 break;
1174 } else
1175 ret = 0;
1176 } else if (h_ret != H_PAGE_REGISTERED) {
1177 ehca_err(&shca->ib_device, "hipz_reg_rpage_mr failed, "
3750f605
SR		 1178 "h_ret=%lli e_mr=%p i=%x lkey=%x hca_hndl=%llx "
1179 "mr_hndl=%llx", h_ret, e_mr, i,
fab97220
HS		 1180 e_mr->ib.ib_mr.lkey,
1181 shca->ipz_hca_handle.handle,
1182 e_mr->ipz_mr_handle.handle);
a1a6ff11 1183 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 1184 break;
1185 } else
1186 ret = 0;
1187 } /* end for(i) */
1188
1189
1190ehca_reg_mr_rpages_exit1:
7e28db5d 1191 ehca_free_fw_ctrlblock(kpage);
fab97220
HS		 1192ehca_reg_mr_rpages_exit0:
1193 if (ret)
e3722192 1194 ehca_err(&shca->ib_device, "ret=%i shca=%p e_mr=%p pginfo=%p "
3750f605 1195 "num_kpages=%llx num_hwpages=%llx", ret, shca, e_mr,
df17bfd4 1196 pginfo, pginfo->num_kpages, pginfo->num_hwpages);
fab97220
HS		 1197 return ret;
1198} /* end ehca_reg_mr_rpages() */
1199
1200/*----------------------------------------------------------------------*/
1201
1202inline int ehca_rereg_mr_rereg1(struct ehca_shca *shca,
1203 struct ehca_mr *e_mr,
1204 u64 *iova_start,
1205 u64 size,
1206 u32 acl,
1207 struct ehca_pd *e_pd,
1208 struct ehca_mr_pginfo *pginfo,
1209 u32 *lkey, /*OUT*/
1210 u32 *rkey) /*OUT*/
1211{
1212 int ret;
1213 u64 h_ret;
1214 u32 hipz_acl;
1215 u64 *kpage;
1216 u64 rpage;
1217 struct ehca_mr_pginfo pginfo_save;
2b94397a 1218 struct ehca_mr_hipzout_parms hipzout;
fab97220
HS		 1219
1220 ehca_mrmw_map_acl(acl, &hipz_acl);
5bb7d929 1221 ehca_mrmw_set_pgsize_hipz_acl(pginfo->hwpage_size, &hipz_acl);
fab97220 1222
f2d91361 1223 kpage = ehca_alloc_fw_ctrlblock(GFP_KERNEL);
fab97220
HS		 1224 if (!kpage) {
1225 ehca_err(&shca->ib_device, "kpage alloc failed");
1226 ret = -ENOMEM;
1227 goto ehca_rereg_mr_rereg1_exit0;
1228 }
1229
1230 pginfo_save = *pginfo;
187c72e3 1231 ret = ehca_set_pagebuf(pginfo, pginfo->num_hwpages, kpage);
fab97220
HS		 1232 if (ret) {
1233 ehca_err(&shca->ib_device, "set pagebuf failed, e_mr=%p "
3750f605 1234 "pginfo=%p type=%x num_kpages=%llx num_hwpages=%llx "
df17bfd4
HNN		 1235 "kpage=%p", e_mr, pginfo, pginfo->type,
1236 pginfo->num_kpages, pginfo->num_hwpages, kpage);
fab97220
HS		 1237 goto ehca_rereg_mr_rereg1_exit1;
1238 }
1239 rpage = virt_to_abs(kpage);
1240 if (!rpage) {
1241 ehca_err(&shca->ib_device, "kpage=%p", kpage);
1242 ret = -EFAULT;
1243 goto ehca_rereg_mr_rereg1_exit1;
1244 }
1245 h_ret = hipz_h_reregister_pmr(shca->ipz_hca_handle, e_mr,
1246 (u64)iova_start, size, hipz_acl,
1247 e_pd->fw_pd, rpage, &hipzout);
1248 if (h_ret != H_SUCCESS) {
1249 /*
1250 * reregistration unsuccessful, try it again with the 3 hCalls,
1251 * e.g. this is required in case H_MR_CONDITION
1252 * (MW bound or MR is shared)
1253 */
1254 ehca_warn(&shca->ib_device, "hipz_h_reregister_pmr failed "
3750f605 1255 "(Rereg1), h_ret=%lli e_mr=%p", h_ret, e_mr);
fab97220
HS		 1256 *pginfo = pginfo_save;
1257 ret = -EAGAIN;
2b94397a 1258 } else if ((u64 *)hipzout.vaddr != iova_start) {
fab97220 1259 ehca_err(&shca->ib_device, "PHYP changed iova_start in "
3750f605
SR		 1260 "rereg_pmr, iova_start=%p iova_start_out=%llx e_mr=%p "
1261 "mr_handle=%llx lkey=%x lkey_out=%x", iova_start,
fab97220
HS		 1262 hipzout.vaddr, e_mr, e_mr->ipz_mr_handle.handle,
1263 e_mr->ib.ib_mr.lkey, hipzout.lkey);
1264 ret = -EFAULT;
1265 } else {
1266 /*
1267 * successful reregistration
1268 * note: start and start_out are identical for eServer HCAs
1269 */
df17bfd4
HNN		 1270 e_mr->num_kpages = pginfo->num_kpages;
1271 e_mr->num_hwpages = pginfo->num_hwpages;
5bb7d929 1272 e_mr->hwpage_size = pginfo->hwpage_size;
df17bfd4
HNN		 1273 e_mr->start = iova_start;
1274 e_mr->size = size;
1275 e_mr->acl = acl;
fab97220
HS		 1276 *lkey = hipzout.lkey;
1277 *rkey = hipzout.rkey;
1278 }
1279
1280ehca_rereg_mr_rereg1_exit1:
7e28db5d 1281 ehca_free_fw_ctrlblock(kpage);
fab97220
HS		 1282ehca_rereg_mr_rereg1_exit0:
1283 if ( ret && (ret != -EAGAIN) )
e3722192 1284 ehca_err(&shca->ib_device, "ret=%i lkey=%x rkey=%x "
3750f605 1285 "pginfo=%p num_kpages=%llx num_hwpages=%llx",
df17bfd4
HNN		 1286 ret, *lkey, *rkey, pginfo, pginfo->num_kpages,
1287 pginfo->num_hwpages);
fab97220
HS		 1288 return ret;
1289} /* end ehca_rereg_mr_rereg1() */
1290
1291/*----------------------------------------------------------------------*/
1292
1293int ehca_rereg_mr(struct ehca_shca *shca,
1294 struct ehca_mr *e_mr,
1295 u64 *iova_start,
1296 u64 size,
1297 int acl,
1298 struct ehca_pd *e_pd,
1299 struct ehca_mr_pginfo *pginfo,
1300 u32 *lkey,
1301 u32 *rkey)
1302{
1303 int ret = 0;
1304 u64 h_ret;
1305 int rereg_1_hcall = 1; /* 1: use hipz_h_reregister_pmr directly */
1306 int rereg_3_hcall = 0; /* 1: use 3 hipz calls for reregistration */
1307
1308 /* first determine reregistration hCall(s) */
df17bfd4
HNN		 1309 if ((pginfo->num_hwpages > MAX_RPAGES) ||
1310 (e_mr->num_hwpages > MAX_RPAGES) ||
1311 (pginfo->num_hwpages > e_mr->num_hwpages)) {
1312 ehca_dbg(&shca->ib_device, "Rereg3 case, "
3750f605 1313 "pginfo->num_hwpages=%llx e_mr->num_hwpages=%x",
df17bfd4 1314 pginfo->num_hwpages, e_mr->num_hwpages);
fab97220
HS		 1315 rereg_1_hcall = 0;
1316 rereg_3_hcall = 1;
1317 }
1318
1319 if (e_mr->flags & EHCA_MR_FLAG_MAXMR) { /* check for max-MR */
1320 rereg_1_hcall = 0;
1321 rereg_3_hcall = 1;
1322 e_mr->flags &= ~EHCA_MR_FLAG_MAXMR;
1323 ehca_err(&shca->ib_device, "Rereg MR for max-MR! e_mr=%p",
1324 e_mr);
1325 }
1326
1327 if (rereg_1_hcall) {
1328 ret = ehca_rereg_mr_rereg1(shca, e_mr, iova_start, size,
1329 acl, e_pd, pginfo, lkey, rkey);
1330 if (ret) {
1331 if (ret == -EAGAIN)
1332 rereg_3_hcall = 1;
1333 else
1334 goto ehca_rereg_mr_exit0;
1335 }
1336 }
1337
1338 if (rereg_3_hcall) {
1339 struct ehca_mr save_mr;
1340
1341 /* first deregister old MR */
1342 h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_mr);
1343 if (h_ret != H_SUCCESS) {
1344 ehca_err(&shca->ib_device, "hipz_free_mr failed, "
3750f605 1345 "h_ret=%lli e_mr=%p hca_hndl=%llx mr_hndl=%llx "
fab97220
HS		 1346 "mr->lkey=%x",
1347 h_ret, e_mr, shca->ipz_hca_handle.handle,
1348 e_mr->ipz_mr_handle.handle,
1349 e_mr->ib.ib_mr.lkey);
a1a6ff11 1350 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 1351 goto ehca_rereg_mr_exit0;
1352 }
1353 /* clean ehca_mr_t, without changing struct ib_mr and lock */
1354 save_mr = *e_mr;
1355 ehca_mr_deletenew(e_mr);
1356
1357 /* set some MR values */
1358 e_mr->flags = save_mr.flags;
5bb7d929 1359 e_mr->hwpage_size = save_mr.hwpage_size;
fab97220
HS		 1360 e_mr->fmr_page_size = save_mr.fmr_page_size;
1361 e_mr->fmr_max_pages = save_mr.fmr_max_pages;
1362 e_mr->fmr_max_maps = save_mr.fmr_max_maps;
1363 e_mr->fmr_map_cnt = save_mr.fmr_map_cnt;
1364
1365 ret = ehca_reg_mr(shca, e_mr, iova_start, size, acl,
0cf89dcd 1366 e_pd, pginfo, lkey, rkey, EHCA_REG_MR);
fab97220
HS		 1367 if (ret) {
1368 u32 offset = (u64)(&e_mr->flags) - (u64)e_mr;
1369 memcpy(&e_mr->flags, &(save_mr.flags),
1370 sizeof(struct ehca_mr) - offset);
1371 goto ehca_rereg_mr_exit0;
1372 }
1373 }
1374
1375ehca_rereg_mr_exit0:
1376 if (ret)
e3722192 1377 ehca_err(&shca->ib_device, "ret=%i shca=%p e_mr=%p "
3750f605
SR		 1378 "iova_start=%p size=%llx acl=%x e_pd=%p pginfo=%p "
1379 "num_kpages=%llx lkey=%x rkey=%x rereg_1_hcall=%x "
fab97220 1380 "rereg_3_hcall=%x", ret, shca, e_mr, iova_start, size,
df17bfd4 1381 acl, e_pd, pginfo, pginfo->num_kpages, *lkey, *rkey,
fab97220
HS		 1382 rereg_1_hcall, rereg_3_hcall);
1383 return ret;
1384} /* end ehca_rereg_mr() */
1385
1386/*----------------------------------------------------------------------*/
1387
1388int ehca_unmap_one_fmr(struct ehca_shca *shca,
1389 struct ehca_mr *e_fmr)
1390{
1391 int ret = 0;
1392 u64 h_ret;
fab97220
HS		 1393 struct ehca_pd *e_pd =
1394 container_of(e_fmr->ib.ib_fmr.pd, struct ehca_pd, ib_pd);
1395 struct ehca_mr save_fmr;
1396 u32 tmp_lkey, tmp_rkey;
df17bfd4 1397 struct ehca_mr_pginfo pginfo;
2b94397a 1398 struct ehca_mr_hipzout_parms hipzout;
187c72e3 1399 struct ehca_mr save_mr;
fab97220 1400
187c72e3 1401 if (e_fmr->fmr_max_pages <= MAX_RPAGES) {
fab97220
HS		 1402 /*
1403 * note: after using rereg hcall with len=0,
1404 * rereg hcall must be used again for registering pages
1405 */
1406 h_ret = hipz_h_reregister_pmr(shca->ipz_hca_handle, e_fmr, 0,
1407 0, 0, e_pd->fw_pd, 0, &hipzout);
187c72e3 1408 if (h_ret == H_SUCCESS) {
fab97220
HS		 1409 /* successful reregistration */
1410 e_fmr->start = NULL;
1411 e_fmr->size = 0;
1412 tmp_lkey = hipzout.lkey;
1413 tmp_rkey = hipzout.rkey;
187c72e3 1414 return 0;
fab97220 1415 }
187c72e3
HNN		 1416 /*
1417 * should not happen, because length checked above,
1418 * FMRs are not shared and no MW bound to FMRs
1419 */
1420 ehca_err(&shca->ib_device, "hipz_reregister_pmr failed "
3750f605
SR		 1421 "(Rereg1), h_ret=%lli e_fmr=%p hca_hndl=%llx "
1422 "mr_hndl=%llx lkey=%x lkey_out=%x",
187c72e3
HNN		 1423 h_ret, e_fmr, shca->ipz_hca_handle.handle,
1424 e_fmr->ipz_mr_handle.handle,
1425 e_fmr->ib.ib_fmr.lkey, hipzout.lkey);
1426 /* try free and rereg */
fab97220
HS		 1427 }
1428
187c72e3
HNN		 1429 /* first free old FMR */
1430 h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_fmr);
1431 if (h_ret != H_SUCCESS) {
1432 ehca_err(&shca->ib_device, "hipz_free_mr failed, "
3750f605 1433 "h_ret=%lli e_fmr=%p hca_hndl=%llx mr_hndl=%llx "
187c72e3
HNN		 1434 "lkey=%x",
1435 h_ret, e_fmr, shca->ipz_hca_handle.handle,
1436 e_fmr->ipz_mr_handle.handle,
1437 e_fmr->ib.ib_fmr.lkey);
1438 ret = ehca2ib_return_code(h_ret);
1439 goto ehca_unmap_one_fmr_exit0;
1440 }
1441 /* clean ehca_mr_t, without changing lock */
1442 save_fmr = *e_fmr;
1443 ehca_mr_deletenew(e_fmr);
fab97220 1444
187c72e3
HNN		 1445 /* set some MR values */
1446 e_fmr->flags = save_fmr.flags;
5bb7d929 1447 e_fmr->hwpage_size = save_fmr.hwpage_size;
187c72e3
HNN		 1448 e_fmr->fmr_page_size = save_fmr.fmr_page_size;
1449 e_fmr->fmr_max_pages = save_fmr.fmr_max_pages;
1450 e_fmr->fmr_max_maps = save_fmr.fmr_max_maps;
1451 e_fmr->fmr_map_cnt = save_fmr.fmr_map_cnt;
1452 e_fmr->acl = save_fmr.acl;
fab97220 1453
187c72e3
HNN		 1454 memset(&pginfo, 0, sizeof(pginfo));
1455 pginfo.type = EHCA_MR_PGI_FMR;
187c72e3
HNN		 1456 ret = ehca_reg_mr(shca, e_fmr, NULL,
1457 (e_fmr->fmr_max_pages * e_fmr->fmr_page_size),
1458 e_fmr->acl, e_pd, &pginfo, &tmp_lkey,
0cf89dcd 1459 &tmp_rkey, EHCA_REG_MR);
187c72e3
HNN		 1460 if (ret) {
1461 u32 offset = (u64)(&e_fmr->flags) - (u64)e_fmr;
1462 memcpy(&e_fmr->flags, &(save_mr.flags),
1463 sizeof(struct ehca_mr) - offset);
fab97220
HS		 1464 }
1465
1466ehca_unmap_one_fmr_exit0:
1467 if (ret)
e3722192 1468 ehca_err(&shca->ib_device, "ret=%i tmp_lkey=%x tmp_rkey=%x "
187c72e3
HNN		 1469 "fmr_max_pages=%x",
1470 ret, tmp_lkey, tmp_rkey, e_fmr->fmr_max_pages);
fab97220
HS		 1471 return ret;
1472} /* end ehca_unmap_one_fmr() */
1473
1474/*----------------------------------------------------------------------*/
1475
1476int ehca_reg_smr(struct ehca_shca *shca,
1477 struct ehca_mr *e_origmr,
1478 struct ehca_mr *e_newmr,
1479 u64 *iova_start,
1480 int acl,
1481 struct ehca_pd *e_pd,
1482 u32 *lkey, /*OUT*/
1483 u32 *rkey) /*OUT*/
1484{
1485 int ret = 0;
1486 u64 h_ret;
1487 u32 hipz_acl;
2b94397a 1488 struct ehca_mr_hipzout_parms hipzout;
fab97220
HS		 1489
1490 ehca_mrmw_map_acl(acl, &hipz_acl);
5bb7d929 1491 ehca_mrmw_set_pgsize_hipz_acl(e_origmr->hwpage_size, &hipz_acl);
fab97220
HS		 1492
1493 h_ret = hipz_h_register_smr(shca->ipz_hca_handle, e_newmr, e_origmr,
1494 (u64)iova_start, hipz_acl, e_pd->fw_pd,
1495 &hipzout);
1496 if (h_ret != H_SUCCESS) {
3750f605 1497 ehca_err(&shca->ib_device, "hipz_reg_smr failed, h_ret=%lli "
fab97220 1498 "shca=%p e_origmr=%p e_newmr=%p iova_start=%p acl=%x "
3750f605 1499 "e_pd=%p hca_hndl=%llx mr_hndl=%llx lkey=%x",
fab97220
HS		 1500 h_ret, shca, e_origmr, e_newmr, iova_start, acl, e_pd,
1501 shca->ipz_hca_handle.handle,
1502 e_origmr->ipz_mr_handle.handle,
1503 e_origmr->ib.ib_mr.lkey);
a1a6ff11 1504 ret = ehca2ib_return_code(h_ret);
fab97220
HS		 1505 goto ehca_reg_smr_exit0;
1506 }
1507 /* successful registration */
df17bfd4
HNN		 1508 e_newmr->num_kpages = e_origmr->num_kpages;
1509 e_newmr->num_hwpages = e_origmr->num_hwpages;
5bb7d929 1510 e_newmr->hwpage_size = e_origmr->hwpage_size;
df17bfd4
HNN		 1511 e_newmr->start = iova_start;
1512 e_newmr->size = e_origmr->size;
1513 e_newmr->acl = acl;
fab97220
HS		 1514 e_newmr->ipz_mr_handle = hipzout.handle;
1515 *lkey = hipzout.lkey;
1516 *rkey = hipzout.rkey;
1517 return 0;
1518
1519ehca_reg_smr_exit0:
1520 if (ret)
e3722192 1521 ehca_err(&shca->ib_device, "ret=%i shca=%p e_origmr=%p "
fab97220
HS		 1522 "e_newmr=%p iova_start=%p acl=%x e_pd=%p",
1523 ret, shca, e_origmr, e_newmr, iova_start, acl, e_pd);
1524 return ret;
1525} /* end ehca_reg_smr() */
1526
1527/*----------------------------------------------------------------------*/
0cf89dcd
HH		 1528static inline void *ehca_calc_sectbase(int top, int dir, int idx)
1529{
1530 unsigned long ret = idx;
1531 ret |= dir << EHCA_DIR_INDEX_SHIFT;
1532 ret |= top << EHCA_TOP_INDEX_SHIFT;
1533 return abs_to_virt(ret << SECTION_SIZE_BITS);
1534}
1535
1536#define ehca_bmap_valid(entry) \
1537 ((u64)entry != (u64)EHCA_INVAL_ADDR)
1538
1539static u64 ehca_reg_mr_section(int top, int dir, int idx, u64 *kpage,
1540 struct ehca_shca *shca, struct ehca_mr *mr,
1541 struct ehca_mr_pginfo *pginfo)
1542{
1543 u64 h_ret = 0;
1544 unsigned long page = 0;
1545 u64 rpage = virt_to_abs(kpage);
1546 int page_count;
1547
1548 void *sectbase = ehca_calc_sectbase(top, dir, idx);
1549 if ((unsigned long)sectbase & (pginfo->hwpage_size - 1)) {
1550 ehca_err(&shca->ib_device, "reg_mr_section will probably fail:"
1551 "hwpage_size does not fit to "
1552 "section start address");
1553 }
1554 page_count = EHCA_SECTSIZE / pginfo->hwpage_size;
1555
1556 while (page < page_count) {
1557 u64 rnum;
1558 for (rnum = 0; (rnum < MAX_RPAGES) && (page < page_count);
1559 rnum++) {
1560 void *pg = sectbase + ((page++) * pginfo->hwpage_size);
1561 kpage[rnum] = virt_to_abs(pg);
1562 }
1563
1564 h_ret = hipz_h_register_rpage_mr(shca->ipz_hca_handle, mr,
1565 ehca_encode_hwpage_size(pginfo->hwpage_size),
1566 0, rpage, rnum);
1567
1568 if ((h_ret != H_SUCCESS) && (h_ret != H_PAGE_REGISTERED)) {
1569 ehca_err(&shca->ib_device, "register_rpage_mr failed");
1570 return h_ret;
1571 }
1572 }
1573 return h_ret;
1574}
1575
1576static u64 ehca_reg_mr_sections(int top, int dir, u64 *kpage,
1577 struct ehca_shca *shca, struct ehca_mr *mr,
1578 struct ehca_mr_pginfo *pginfo)
1579{
1580 u64 hret = H_SUCCESS;
1581 int idx;
1582
1583 for (idx = 0; idx < EHCA_MAP_ENTRIES; idx++) {
1584 if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir]->ent[idx]))
1585 continue;
1586
1587 hret = ehca_reg_mr_section(top, dir, idx, kpage, shca, mr,
1588 pginfo);
1589 if ((hret != H_SUCCESS) && (hret != H_PAGE_REGISTERED))
1590 return hret;
1591 }
1592 return hret;
1593}
1594
1595static u64 ehca_reg_mr_dir_sections(int top, u64 *kpage, struct ehca_shca *shca,
1596 struct ehca_mr *mr,
1597 struct ehca_mr_pginfo *pginfo)
1598{
1599 u64 hret = H_SUCCESS;
1600 int dir;
1601
1602 for (dir = 0; dir < EHCA_MAP_ENTRIES; dir++) {
1603 if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir]))
1604 continue;
1605
1606 hret = ehca_reg_mr_sections(top, dir, kpage, shca, mr, pginfo);
1607 if ((hret != H_SUCCESS) && (hret != H_PAGE_REGISTERED))
1608 return hret;
1609 }
1610 return hret;
1611}
fab97220
HS		 1612
1613/* register internal max-MR to internal SHCA */
1614int ehca_reg_internal_maxmr(
1615 struct ehca_shca *shca,
1616 struct ehca_pd *e_pd,
1617 struct ehca_mr **e_maxmr) /*OUT*/
1618{
1619 int ret;
1620 struct ehca_mr *e_mr;
1621 u64 *iova_start;
1622 u64 size_maxmr;
df17bfd4 1623 struct ehca_mr_pginfo pginfo;
fab97220 1624 struct ib_phys_buf ib_pbuf;
df17bfd4
HNN		 1625 u32 num_kpages;
1626 u32 num_hwpages;
5bb7d929 1627 u64 hw_pgsize;
fab97220 1628
0cf89dcd
HH		 1629 if (!ehca_bmap) {
1630 ret = -EFAULT;
1631 goto ehca_reg_internal_maxmr_exit0;
1632 }
1633
fab97220
HS		 1634 e_mr = ehca_mr_new();
1635 if (!e_mr) {
1636 ehca_err(&shca->ib_device, "out of memory");
1637 ret = -ENOMEM;
1638 goto ehca_reg_internal_maxmr_exit0;
1639 }
1640 e_mr->flags |= EHCA_MR_FLAG_MAXMR;
1641
1642 /* register internal max-MR on HCA */
0cf89dcd
HH		 1643 size_maxmr = ehca_mr_len;
1644 iova_start = (u64 *)ehca_map_vaddr((void *)KERNELBASE);
fab97220
HS		 1645 ib_pbuf.addr = 0;
1646 ib_pbuf.size = size_maxmr;
df17bfd4
HNN		 1647 num_kpages = NUM_CHUNKS(((u64)iova_start % PAGE_SIZE) + size_maxmr,
1648 PAGE_SIZE);
5bb7d929
HNN		 1649 hw_pgsize = ehca_get_max_hwpage_size(shca);
1650 num_hwpages = NUM_CHUNKS(((u64)iova_start % hw_pgsize) + size_maxmr,
1651 hw_pgsize);
df17bfd4
HNN		 1652
1653 memset(&pginfo, 0, sizeof(pginfo));
1654 pginfo.type = EHCA_MR_PGI_PHYS;
1655 pginfo.num_kpages = num_kpages;
1656 pginfo.num_hwpages = num_hwpages;
5bb7d929 1657 pginfo.hwpage_size = hw_pgsize;
df17bfd4
HNN		 1658 pginfo.u.phy.num_phys_buf = 1;
1659 pginfo.u.phy.phys_buf_array = &ib_pbuf;
fab97220
HS		 1660
1661 ret = ehca_reg_mr(shca, e_mr, iova_start, size_maxmr, 0, e_pd,
1662 &pginfo, &e_mr->ib.ib_mr.lkey,
0cf89dcd 1663 &e_mr->ib.ib_mr.rkey, EHCA_REG_BUSMAP_MR);
fab97220
HS		 1664 if (ret) {
1665 ehca_err(&shca->ib_device, "reg of internal max MR failed, "
3750f605 1666 "e_mr=%p iova_start=%p size_maxmr=%llx num_kpages=%x "
df17bfd4
HNN		 1667 "num_hwpages=%x", e_mr, iova_start, size_maxmr,
1668 num_kpages, num_hwpages);
fab97220
HS		 1669 goto ehca_reg_internal_maxmr_exit1;
1670 }
1671
1672 /* successful registration of all pages */
1673 e_mr->ib.ib_mr.device = e_pd->ib_pd.device;
1674 e_mr->ib.ib_mr.pd = &e_pd->ib_pd;
1675 e_mr->ib.ib_mr.uobject = NULL;
1676 atomic_inc(&(e_pd->ib_pd.usecnt));
1677 atomic_set(&(e_mr->ib.ib_mr.usecnt), 0);
1678 *e_maxmr = e_mr;
1679 return 0;
1680
1681ehca_reg_internal_maxmr_exit1:
1682 ehca_mr_delete(e_mr);
1683ehca_reg_internal_maxmr_exit0:
1684 if (ret)
e3722192 1685 ehca_err(&shca->ib_device, "ret=%i shca=%p e_pd=%p e_maxmr=%p",
fab97220
HS		 1686 ret, shca, e_pd, e_maxmr);
1687 return ret;
1688} /* end ehca_reg_internal_maxmr() */
1689
1690/*----------------------------------------------------------------------*/
1691
1692int ehca_reg_maxmr(struct ehca_shca *shca,
1693 struct ehca_mr *e_newmr,
1694 u64 *iova_start,
1695 int acl,
1696 struct ehca_pd *e_pd,
1697 u32 *lkey,
1698 u32 *rkey)
1699{
1700 u64 h_ret;
1701 struct ehca_mr *e_origmr = shca->maxmr;
1702 u32 hipz_acl;
2b94397a 1703 struct ehca_mr_hipzout_parms hipzout;
fab97220
HS		 1704
1705 ehca_mrmw_map_acl(acl, &hipz_acl);
5bb7d929 1706 ehca_mrmw_set_pgsize_hipz_acl(e_origmr->hwpage_size, &hipz_acl);
fab97220
HS		 1707
1708 h_ret = hipz_h_register_smr(shca->ipz_hca_handle, e_newmr, e_origmr,
1709 (u64)iova_start, hipz_acl, e_pd->fw_pd,
1710 &hipzout);
1711 if (h_ret != H_SUCCESS) {
3750f605
SR		 1712 ehca_err(&shca->ib_device, "hipz_reg_smr failed, h_ret=%lli "
1713 "e_origmr=%p hca_hndl=%llx mr_hndl=%llx lkey=%x",
fab97220
HS		 1714 h_ret, e_origmr, shca->ipz_hca_handle.handle,
1715 e_origmr->ipz_mr_handle.handle,
1716 e_origmr->ib.ib_mr.lkey);
a1a6ff11 1717 return ehca2ib_return_code(h_ret);
fab97220
HS		 1718 }
1719 /* successful registration */
df17bfd4
HNN		 1720 e_newmr->num_kpages = e_origmr->num_kpages;
1721 e_newmr->num_hwpages = e_origmr->num_hwpages;
5bb7d929 1722 e_newmr->hwpage_size = e_origmr->hwpage_size;
df17bfd4
HNN		 1723 e_newmr->start = iova_start;
1724 e_newmr->size = e_origmr->size;
1725 e_newmr->acl = acl;
fab97220
HS		 1726 e_newmr->ipz_mr_handle = hipzout.handle;
1727 *lkey = hipzout.lkey;
1728 *rkey = hipzout.rkey;
1729 return 0;
1730} /* end ehca_reg_maxmr() */
1731
1732/*----------------------------------------------------------------------*/
1733
1734int ehca_dereg_internal_maxmr(struct ehca_shca *shca)
1735{
1736 int ret;
1737 struct ehca_mr *e_maxmr;
1738 struct ib_pd *ib_pd;
1739
1740 if (!shca->maxmr) {
1741 ehca_err(&shca->ib_device, "bad call, shca=%p", shca);
1742 ret = -EINVAL;
1743 goto ehca_dereg_internal_maxmr_exit0;
1744 }
1745
1746 e_maxmr = shca->maxmr;
1747 ib_pd = e_maxmr->ib.ib_mr.pd;
1748 shca->maxmr = NULL; /* remove internal max-MR indication from SHCA */
1749
1750 ret = ehca_dereg_mr(&e_maxmr->ib.ib_mr);
1751 if (ret) {
1752 ehca_err(&shca->ib_device, "dereg internal max-MR failed, "
e3722192 1753 "ret=%i e_maxmr=%p shca=%p lkey=%x",
fab97220
HS		 1754 ret, e_maxmr, shca, e_maxmr->ib.ib_mr.lkey);
1755 shca->maxmr = e_maxmr;
1756 goto ehca_dereg_internal_maxmr_exit0;
1757 }
1758
1759 atomic_dec(&ib_pd->usecnt);
1760
1761ehca_dereg_internal_maxmr_exit0:
1762 if (ret)
e3722192 1763 ehca_err(&shca->ib_device, "ret=%i shca=%p shca->maxmr=%p",
fab97220
HS		 1764 ret, shca, shca->maxmr);
1765 return ret;
1766} /* end ehca_dereg_internal_maxmr() */
1767
1768/*----------------------------------------------------------------------*/
1769
1770/*
1771 * check physical buffer array of MR verbs for validness and
1772 * calculates MR size
1773 */
1774int ehca_mr_chk_buf_and_calc_size(struct ib_phys_buf *phys_buf_array,
1775 int num_phys_buf,
1776 u64 *iova_start,
1777 u64 *size)
1778{
1779 struct ib_phys_buf *pbuf = phys_buf_array;
1780 u64 size_count = 0;
1781 u32 i;
1782
1783 if (num_phys_buf == 0) {
1784 ehca_gen_err("bad phys buf array len, num_phys_buf=0");
1785 return -EINVAL;
1786 }
1787 /* check first buffer */
1788 if (((u64)iova_start & ~PAGE_MASK) != (pbuf->addr & ~PAGE_MASK)) {
1789 ehca_gen_err("iova_start/addr mismatch, iova_start=%p "
3750f605 1790 "pbuf->addr=%llx pbuf->size=%llx",
fab97220
HS		 1791 iova_start, pbuf->addr, pbuf->size);
1792 return -EINVAL;
1793 }
1794 if (((pbuf->addr + pbuf->size) % PAGE_SIZE) &&
1795 (num_phys_buf > 1)) {
3750f605
SR		 1796 ehca_gen_err("addr/size mismatch in 1st buf, pbuf->addr=%llx "
1797 "pbuf->size=%llx", pbuf->addr, pbuf->size);
fab97220
HS		 1798 return -EINVAL;
1799 }
1800
1801 for (i = 0; i < num_phys_buf; i++) {
1802 if ((i > 0) && (pbuf->addr % PAGE_SIZE)) {
3750f605
SR		 1803 ehca_gen_err("bad address, i=%x pbuf->addr=%llx "
1804 "pbuf->size=%llx",
fab97220
HS		 1805 i, pbuf->addr, pbuf->size);
1806 return -EINVAL;
1807 }
1808 if (((i > 0) && /* not 1st */
1809 (i < (num_phys_buf - 1)) && /* not last */
1810 (pbuf->size % PAGE_SIZE)) || (pbuf->size == 0)) {
3750f605 1811 ehca_gen_err("bad size, i=%x pbuf->size=%llx",
fab97220
HS		 1812 i, pbuf->size);
1813 return -EINVAL;
1814 }
1815 size_count += pbuf->size;
1816 pbuf++;
1817 }
1818
1819 *size = size_count;
1820 return 0;
1821} /* end ehca_mr_chk_buf_and_calc_size() */
1822
1823/*----------------------------------------------------------------------*/
1824
1825/* check page list of map FMR verb for validness */
1826int ehca_fmr_check_page_list(struct ehca_mr *e_fmr,
1827 u64 *page_list,
1828 int list_len)
1829{
1830 u32 i;
1831 u64 *page;
1832
1833 if ((list_len == 0) || (list_len > e_fmr->fmr_max_pages)) {
1834 ehca_gen_err("bad list_len, list_len=%x "
1835 "e_fmr->fmr_max_pages=%x fmr=%p",
1836 list_len, e_fmr->fmr_max_pages, e_fmr);
1837 return -EINVAL;
1838 }
1839
1840 /* each page must be aligned */
1841 page = page_list;
1842 for (i = 0; i < list_len; i++) {
1843 if (*page % e_fmr->fmr_page_size) {
3750f605 1844 ehca_gen_err("bad page, i=%x *page=%llx page=%p fmr=%p "
fab97220
HS		 1845 "fmr_page_size=%x", i, *page, page, e_fmr,
1846 e_fmr->fmr_page_size);
1847 return -EINVAL;
1848 }
1849 page++;
1850 }
1851
1852 return 0;
1853} /* end ehca_fmr_check_page_list() */
1854
1855/*----------------------------------------------------------------------*/
1856
187c72e3
HNN		 1857/* PAGE_SIZE >= pginfo->hwpage_size */
1858static int ehca_set_pagebuf_user1(struct ehca_mr_pginfo *pginfo,
1859 u32 number,
1860 u64 *kpage)
fab97220
HS		 1861{
1862 int ret = 0;
1863 struct ib_umem_chunk *prev_chunk;
1864 struct ib_umem_chunk *chunk;
187c72e3 1865 u64 pgaddr;
fab97220
HS		 1866 u32 i = 0;
1867 u32 j = 0;
5bb7d929 1868 int hwpages_per_kpage = PAGE_SIZE / pginfo->hwpage_size;
fab97220 1869
187c72e3
HNN		 1870 /* loop over desired chunk entries */
1871 chunk = pginfo->u.usr.next_chunk;
1872 prev_chunk = pginfo->u.usr.next_chunk;
1873 list_for_each_entry_continue(
1874 chunk, (&(pginfo->u.usr.region->chunk_list)), list) {
1875 for (i = pginfo->u.usr.next_nmap; i < chunk->nmap; ) {
c8ac5a73 1876 pgaddr = page_to_pfn(sg_page(&chunk->page_list[i]))
187c72e3
HNN		 1877 << PAGE_SHIFT ;
1878 *kpage = phys_to_abs(pgaddr +
1879 (pginfo->next_hwpage *
5bb7d929 1880 pginfo->hwpage_size));
fab97220 1881 if ( !(*kpage) ) {
3750f605
SR		 1882 ehca_gen_err("pgaddr=%llx "
1883 "chunk->page_list[i]=%llx "
1884 "i=%x next_hwpage=%llx",
187c72e3
HNN		 1885 pgaddr, (u64)sg_dma_address(
1886 &chunk->page_list[i]),
1887 i, pginfo->next_hwpage);
1888 return -EFAULT;
fab97220 1889 }
df17bfd4
HNN		 1890 (pginfo->hwpage_cnt)++;
1891 (pginfo->next_hwpage)++;
fab97220 1892 kpage++;
5bb7d929 1893 if (pginfo->next_hwpage % hwpages_per_kpage == 0) {
df17bfd4 1894 (pginfo->kpage_cnt)++;
187c72e3 1895 (pginfo->u.usr.next_nmap)++;
df17bfd4 1896 pginfo->next_hwpage = 0;
187c72e3 1897 i++;
fab97220 1898 }
187c72e3
HNN		 1899 j++;
1900 if (j >= number) break;
fab97220 1901 }
187c72e3
HNN		 1902 if ((pginfo->u.usr.next_nmap >= chunk->nmap) &&
1903 (j >= number)) {
1904 pginfo->u.usr.next_nmap = 0;
1905 prev_chunk = chunk;
1906 break;
1907 } else if (pginfo->u.usr.next_nmap >= chunk->nmap) {
1908 pginfo->u.usr.next_nmap = 0;
1909 prev_chunk = chunk;
1910 } else if (j >= number)
1911 break;
1912 else
1913 prev_chunk = chunk;
fab97220 1914 }
187c72e3
HNN		 1915 pginfo->u.usr.next_chunk =
1916 list_prepare_entry(prev_chunk,
1917 (&(pginfo->u.usr.region->chunk_list)),
1918 list);
fab97220 1919 return ret;
187c72e3 1920}
fab97220 1921
5bb7d929
HNN		 1922/*
1923 * check given pages for contiguous layout
1924 * last page addr is returned in prev_pgaddr for further check
1925 */
1926static int ehca_check_kpages_per_ate(struct scatterlist *page_list,
1927 int start_idx, int end_idx,
1928 u64 *prev_pgaddr)
1929{
1930 int t;
1931 for (t = start_idx; t <= end_idx; t++) {
c8ac5a73 1932 u64 pgaddr = page_to_pfn(sg_page(&page_list[t])) << PAGE_SHIFT;
4da27d6d 1933 if (ehca_debug_level >= 3)
3750f605 1934 ehca_gen_dbg("chunk_page=%llx value=%016llx", pgaddr,
4da27d6d 1935 *(u64 *)abs_to_virt(phys_to_abs(pgaddr)));
5bb7d929 1936 if (pgaddr - PAGE_SIZE != *prev_pgaddr) {
3750f605
SR		 1937 ehca_gen_err("uncontiguous page found pgaddr=%llx "
1938 "prev_pgaddr=%llx page_list_i=%x",
5bb7d929
HNN		 1939 pgaddr, *prev_pgaddr, t);
1940 return -EINVAL;
1941 }
1942 *prev_pgaddr = pgaddr;
1943 }
1944 return 0;
1945}
1946
1947/* PAGE_SIZE < pginfo->hwpage_size */
1948static int ehca_set_pagebuf_user2(struct ehca_mr_pginfo *pginfo,
1949 u32 number,
1950 u64 *kpage)
1951{
1952 int ret = 0;
1953 struct ib_umem_chunk *prev_chunk;
1954 struct ib_umem_chunk *chunk;
1955 u64 pgaddr, prev_pgaddr;
1956 u32 i = 0;
1957 u32 j = 0;
1958 int kpages_per_hwpage = pginfo->hwpage_size / PAGE_SIZE;
1959 int nr_kpages = kpages_per_hwpage;
1960
1961 /* loop over desired chunk entries */
1962 chunk = pginfo->u.usr.next_chunk;
1963 prev_chunk = pginfo->u.usr.next_chunk;
1964 list_for_each_entry_continue(
1965 chunk, (&(pginfo->u.usr.region->chunk_list)), list) {
1966 for (i = pginfo->u.usr.next_nmap; i < chunk->nmap; ) {
1967 if (nr_kpages == kpages_per_hwpage) {
c8ac5a73 1968 pgaddr = ( page_to_pfn(sg_page(&chunk->page_list[i]))
5bb7d929
HNN		 1969 << PAGE_SHIFT );
1970 *kpage = phys_to_abs(pgaddr);
1971 if ( !(*kpage) ) {
3750f605 1972 ehca_gen_err("pgaddr=%llx i=%x",
5bb7d929
HNN		 1973 pgaddr, i);
1974 ret = -EFAULT;
1975 return ret;
1976 }
1977 /*
1978 * The first page in a hwpage must be aligned;
1979 * the first MR page is exempt from this rule.
1980 */
1981 if (pgaddr & (pginfo->hwpage_size - 1)) {
1982 if (pginfo->hwpage_cnt) {
1983 ehca_gen_err(
1984 "invalid alignment "
3750f605
SR		 1985 "pgaddr=%llx i=%x "
1986 "mr_pgsize=%llx",
5bb7d929
HNN		 1987 pgaddr, i,
1988 pginfo->hwpage_size);
1989 ret = -EFAULT;
1990 return ret;
1991 }
1992 /* first MR page */
1993 pginfo->kpage_cnt =
1994 (pgaddr &
1995 (pginfo->hwpage_size - 1)) >>
1996 PAGE_SHIFT;
1997 nr_kpages -= pginfo->kpage_cnt;
1998 *kpage = phys_to_abs(
1999 pgaddr &
2000 ~(pginfo->hwpage_size - 1));
2001 }
4da27d6d
JF		 2002 if (ehca_debug_level >= 3) {
2003 u64 val = *(u64 *)abs_to_virt(
2004 phys_to_abs(pgaddr));
3750f605
SR		 2005 ehca_gen_dbg("kpage=%llx chunk_page=%llx "
2006 "value=%016llx",
4da27d6d
JF		 2007 *kpage, pgaddr, val);
2008 }
5bb7d929
HNN		 2009 prev_pgaddr = pgaddr;
2010 i++;
2011 pginfo->kpage_cnt++;
2012 pginfo->u.usr.next_nmap++;
2013 nr_kpages--;
2014 if (!nr_kpages)
2015 goto next_kpage;
2016 continue;
2017 }
2018 if (i + nr_kpages > chunk->nmap) {
2019 ret = ehca_check_kpages_per_ate(
2020 chunk->page_list, i,
2021 chunk->nmap - 1, &prev_pgaddr);
2022 if (ret) return ret;
2023 pginfo->kpage_cnt += chunk->nmap - i;
2024 pginfo->u.usr.next_nmap += chunk->nmap - i;
2025 nr_kpages -= chunk->nmap - i;
2026 break;
2027 }
2028
2029 ret = ehca_check_kpages_per_ate(chunk->page_list, i,
2030 i + nr_kpages - 1,
2031 &prev_pgaddr);
2032 if (ret) return ret;
2033 i += nr_kpages;
2034 pginfo->kpage_cnt += nr_kpages;
2035 pginfo->u.usr.next_nmap += nr_kpages;
2036next_kpage:
2037 nr_kpages = kpages_per_hwpage;
2038 (pginfo->hwpage_cnt)++;
2039 kpage++;
2040 j++;
2041 if (j >= number) break;
2042 }
2043 if ((pginfo->u.usr.next_nmap >= chunk->nmap) &&
2044 (j >= number)) {
2045 pginfo->u.usr.next_nmap = 0;
2046 prev_chunk = chunk;
2047 break;
2048 } else if (pginfo->u.usr.next_nmap >= chunk->nmap) {
2049 pginfo->u.usr.next_nmap = 0;
2050 prev_chunk = chunk;
2051 } else if (j >= number)
2052 break;
2053 else
2054 prev_chunk = chunk;
2055 }
2056 pginfo->u.usr.next_chunk =
2057 list_prepare_entry(prev_chunk,
2058 (&(pginfo->u.usr.region->chunk_list)),
2059 list);
2060 return ret;
2061}
2062
e8e91f6b
RD		 2063static int ehca_set_pagebuf_phys(struct ehca_mr_pginfo *pginfo,
2064 u32 number, u64 *kpage)
fab97220
HS		 2065{
2066 int ret = 0;
187c72e3
HNN		 2067 struct ib_phys_buf *pbuf;
2068 u64 num_hw, offs_hw;
2069 u32 i = 0;
2070
2071 /* loop over desired phys_buf_array entries */
2072 while (i < number) {
2073 pbuf = pginfo->u.phy.phys_buf_array + pginfo->u.phy.next_buf;
5bb7d929
HNN		 2074 num_hw = NUM_CHUNKS((pbuf->addr % pginfo->hwpage_size) +
2075 pbuf->size, pginfo->hwpage_size);
2076 offs_hw = (pbuf->addr & ~(pginfo->hwpage_size - 1)) /
2077 pginfo->hwpage_size;
187c72e3
HNN		 2078 while (pginfo->next_hwpage < offs_hw + num_hw) {
2079 /* sanity check */
2080 if ((pginfo->kpage_cnt >= pginfo->num_kpages) ||
2081 (pginfo->hwpage_cnt >= pginfo->num_hwpages)) {
2082 ehca_gen_err("kpage_cnt >= num_kpages, "
3750f605
SR		 2083 "kpage_cnt=%llx num_kpages=%llx "
2084 "hwpage_cnt=%llx "
2085 "num_hwpages=%llx i=%x",
187c72e3
HNN		 2086 pginfo->kpage_cnt,
2087 pginfo->num_kpages,
2088 pginfo->hwpage_cnt,
2089 pginfo->num_hwpages, i);
2090 return -EFAULT;
2091 }
2092 *kpage = phys_to_abs(
5bb7d929
HNN		 2093 (pbuf->addr & ~(pginfo->hwpage_size - 1)) +
2094 (pginfo->next_hwpage * pginfo->hwpage_size));
187c72e3 2095 if ( !(*kpage) && pbuf->addr ) {
3750f605
SR		 2096 ehca_gen_err("pbuf->addr=%llx pbuf->size=%llx "
2097 "next_hwpage=%llx", pbuf->addr,
5bb7d929 2098 pbuf->size, pginfo->next_hwpage);
187c72e3 2099 return -EFAULT;
fab97220 2100 }
df17bfd4
HNN		 2101 (pginfo->hwpage_cnt)++;
2102 (pginfo->next_hwpage)++;
5bb7d929
HNN		 2103 if (PAGE_SIZE >= pginfo->hwpage_size) {
2104 if (pginfo->next_hwpage %
2105 (PAGE_SIZE / pginfo->hwpage_size) == 0)
2106 (pginfo->kpage_cnt)++;
2107 } else
2108 pginfo->kpage_cnt += pginfo->hwpage_size /
2109 PAGE_SIZE;
187c72e3
HNN		 2110 kpage++;
2111 i++;
2112 if (i >= number) break;
fab97220 2113 }
187c72e3
HNN		 2114 if (pginfo->next_hwpage >= offs_hw + num_hw) {
2115 (pginfo->u.phy.next_buf)++;
2116 pginfo->next_hwpage = 0;
2117 }
2118 }
2119 return ret;
2120}
2121
e8e91f6b
RD		 2122static int ehca_set_pagebuf_fmr(struct ehca_mr_pginfo *pginfo,
2123 u32 number, u64 *kpage)
187c72e3
HNN		 2124{
2125 int ret = 0;
2126 u64 *fmrlist;
2127 u32 i;
2128
2129 /* loop over desired page_list entries */
2130 fmrlist = pginfo->u.fmr.page_list + pginfo->u.fmr.next_listelem;
2131 for (i = 0; i < number; i++) {
5bb7d929
HNN		 2132 *kpage = phys_to_abs((*fmrlist & ~(pginfo->hwpage_size - 1)) +
2133 pginfo->next_hwpage * pginfo->hwpage_size);
187c72e3 2134 if ( !(*kpage) ) {
3750f605
SR		 2135 ehca_gen_err("*fmrlist=%llx fmrlist=%p "
2136 "next_listelem=%llx next_hwpage=%llx",
187c72e3
HNN		 2137 *fmrlist, fmrlist,
2138 pginfo->u.fmr.next_listelem,
df17bfd4 2139 pginfo->next_hwpage);
187c72e3 2140 return -EFAULT;
fab97220 2141 }
df17bfd4 2142 (pginfo->hwpage_cnt)++;
5bb7d929
HNN		 2143 if (pginfo->u.fmr.fmr_pgsize >= pginfo->hwpage_size) {
2144 if (pginfo->next_hwpage %
2145 (pginfo->u.fmr.fmr_pgsize /
2146 pginfo->hwpage_size) == 0) {
2147 (pginfo->kpage_cnt)++;
2148 (pginfo->u.fmr.next_listelem)++;
2149 fmrlist++;
2150 pginfo->next_hwpage = 0;
2151 } else
2152 (pginfo->next_hwpage)++;
2153 } else {
2154 unsigned int cnt_per_hwpage = pginfo->hwpage_size /
2155 pginfo->u.fmr.fmr_pgsize;
2156 unsigned int j;
2157 u64 prev = *kpage;
2158 /* check if adrs are contiguous */
2159 for (j = 1; j < cnt_per_hwpage; j++) {
2160 u64 p = phys_to_abs(fmrlist[j] &
2161 ~(pginfo->hwpage_size - 1));
2162 if (prev + pginfo->u.fmr.fmr_pgsize != p) {
2163 ehca_gen_err("uncontiguous fmr pages "
3750f605 2164 "found prev=%llx p=%llx "
5bb7d929
HNN		 2165 "idx=%x", prev, p, i + j);
2166 return -EINVAL;
2167 }
2168 prev = p;
2169 }
2170 pginfo->kpage_cnt += cnt_per_hwpage;
2171 pginfo->u.fmr.next_listelem += cnt_per_hwpage;
2172 fmrlist += cnt_per_hwpage;
fab97220 2173 }
5bb7d929 2174 kpage++;
187c72e3
HNN		 2175 }
2176 return ret;
2177}
2178
2179/* setup page buffer from page info */
2180int ehca_set_pagebuf(struct ehca_mr_pginfo *pginfo,
2181 u32 number,
2182 u64 *kpage)
2183{
2184 int ret;
2185
2186 switch (pginfo->type) {
2187 case EHCA_MR_PGI_PHYS:
2188 ret = ehca_set_pagebuf_phys(pginfo, number, kpage);
2189 break;
2190 case EHCA_MR_PGI_USER:
5bb7d929
HNN		 2191 ret = PAGE_SIZE >= pginfo->hwpage_size ?
2192 ehca_set_pagebuf_user1(pginfo, number, kpage) :
2193 ehca_set_pagebuf_user2(pginfo, number, kpage);
187c72e3
HNN		 2194 break;
2195 case EHCA_MR_PGI_FMR:
2196 ret = ehca_set_pagebuf_fmr(pginfo, number, kpage);
2197 break;
2198 default:
fab97220
HS		 2199 ehca_gen_err("bad pginfo->type=%x", pginfo->type);
2200 ret = -EFAULT;
187c72e3 2201 break;
fab97220 2202 }
fab97220 2203 return ret;
187c72e3 2204} /* end ehca_set_pagebuf() */
fab97220
HS		 2205
2206/*----------------------------------------------------------------------*/
2207
2208/*
2209 * check MR if it is a max-MR, i.e. uses whole memory
2210 * in case it's a max-MR 1 is returned, else 0
2211 */
2212int ehca_mr_is_maxmr(u64 size,
2213 u64 *iova_start)
2214{
2215 /* a MR is treated as max-MR only if it fits following: */
0cf89dcd
HH		 2216 if ((size == ehca_mr_len) &&
2217 (iova_start == (void *)ehca_map_vaddr((void *)KERNELBASE))) {
fab97220
HS		 2218 ehca_gen_dbg("this is a max-MR");
2219 return 1;
2220 } else
2221 return 0;
2222} /* end ehca_mr_is_maxmr() */
2223
2224/*----------------------------------------------------------------------*/
2225
2226/* map access control for MR/MW. This routine is used for MR and MW. */
2227void ehca_mrmw_map_acl(int ib_acl,
2228 u32 *hipz_acl)
2229{
2230 *hipz_acl = 0;
2231 if (ib_acl & IB_ACCESS_REMOTE_READ)
2232 *hipz_acl |= HIPZ_ACCESSCTRL_R_READ;
2233 if (ib_acl & IB_ACCESS_REMOTE_WRITE)
2234 *hipz_acl |= HIPZ_ACCESSCTRL_R_WRITE;
2235 if (ib_acl & IB_ACCESS_REMOTE_ATOMIC)
2236 *hipz_acl |= HIPZ_ACCESSCTRL_R_ATOMIC;
2237 if (ib_acl & IB_ACCESS_LOCAL_WRITE)
2238 *hipz_acl |= HIPZ_ACCESSCTRL_L_WRITE;
2239 if (ib_acl & IB_ACCESS_MW_BIND)
2240 *hipz_acl |= HIPZ_ACCESSCTRL_MW_BIND;
2241} /* end ehca_mrmw_map_acl() */
2242
2243/*----------------------------------------------------------------------*/
2244
2245/* sets page size in hipz access control for MR/MW. */
5bb7d929 2246void ehca_mrmw_set_pgsize_hipz_acl(u32 pgsize, u32 *hipz_acl) /*INOUT*/
fab97220 2247{
5bb7d929 2248 *hipz_acl |= (ehca_encode_hwpage_size(pgsize) << 24);
fab97220
HS		 2249} /* end ehca_mrmw_set_pgsize_hipz_acl() */
2250
2251/*----------------------------------------------------------------------*/
2252
2253/*
2254 * reverse map access control for MR/MW.
2255 * This routine is used for MR and MW.
2256 */
2257void ehca_mrmw_reverse_map_acl(const u32 *hipz_acl,
2258 int *ib_acl) /*OUT*/
2259{
2260 *ib_acl = 0;
2261 if (*hipz_acl & HIPZ_ACCESSCTRL_R_READ)
2262 *ib_acl |= IB_ACCESS_REMOTE_READ;
2263 if (*hipz_acl & HIPZ_ACCESSCTRL_R_WRITE)
2264 *ib_acl |= IB_ACCESS_REMOTE_WRITE;
2265 if (*hipz_acl & HIPZ_ACCESSCTRL_R_ATOMIC)
2266 *ib_acl |= IB_ACCESS_REMOTE_ATOMIC;
2267 if (*hipz_acl & HIPZ_ACCESSCTRL_L_WRITE)
2268 *ib_acl |= IB_ACCESS_LOCAL_WRITE;
2269 if (*hipz_acl & HIPZ_ACCESSCTRL_MW_BIND)
2270 *ib_acl |= IB_ACCESS_MW_BIND;
2271} /* end ehca_mrmw_reverse_map_acl() */
2272
2273
fab97220
HS		 2274/*----------------------------------------------------------------------*/
2275
2276/*
2277 * MR destructor and constructor
2278 * used in Reregister MR verb, sets all fields in ehca_mr_t to 0,
2279 * except struct ib_mr and spinlock
2280 */
2281void ehca_mr_deletenew(struct ehca_mr *mr)
2282{
df17bfd4
HNN		 2283 mr->flags = 0;
2284 mr->num_kpages = 0;
2285 mr->num_hwpages = 0;
2286 mr->acl = 0;
2287 mr->start = NULL;
fab97220
HS		 2288 mr->fmr_page_size = 0;
2289 mr->fmr_max_pages = 0;
df17bfd4
HNN		 2290 mr->fmr_max_maps = 0;
2291 mr->fmr_map_cnt = 0;
fab97220
HS		 2292 memset(&mr->ipz_mr_handle, 0, sizeof(mr->ipz_mr_handle));
2293 memset(&mr->galpas, 0, sizeof(mr->galpas));
fab97220
HS		 2294} /* end ehca_mr_deletenew() */
2295
2296int ehca_init_mrmw_cache(void)
2297{
2298 mr_cache = kmem_cache_create("ehca_cache_mr",
2299 sizeof(struct ehca_mr), 0,
2300 SLAB_HWCACHE_ALIGN,
20c2df83 2301 NULL);
fab97220
HS		 2302 if (!mr_cache)
2303 return -ENOMEM;
2304 mw_cache = kmem_cache_create("ehca_cache_mw",
2305 sizeof(struct ehca_mw), 0,
2306 SLAB_HWCACHE_ALIGN,
20c2df83 2307 NULL);
fab97220
HS		 2308 if (!mw_cache) {
2309 kmem_cache_destroy(mr_cache);
2310 mr_cache = NULL;
2311 return -ENOMEM;
2312 }
2313 return 0;
2314}
2315
2316void ehca_cleanup_mrmw_cache(void)
2317{
2318 if (mr_cache)
2319 kmem_cache_destroy(mr_cache);
2320 if (mw_cache)
2321 kmem_cache_destroy(mw_cache);
2322}
0cf89dcd
HH		 2323
2324static inline int ehca_init_top_bmap(struct ehca_top_bmap *ehca_top_bmap,
2325 int dir)
2326{
2327 if (!ehca_bmap_valid(ehca_top_bmap->dir[dir])) {
2328 ehca_top_bmap->dir[dir] =
2329 kmalloc(sizeof(struct ehca_dir_bmap), GFP_KERNEL);
2330 if (!ehca_top_bmap->dir[dir])
2331 return -ENOMEM;
2332 /* Set map block to 0xFF according to EHCA_INVAL_ADDR */
2333 memset(ehca_top_bmap->dir[dir], 0xFF, EHCA_ENT_MAP_SIZE);
2334 }
2335 return 0;
2336}
2337
2338static inline int ehca_init_bmap(struct ehca_bmap *ehca_bmap, int top, int dir)
2339{
2340 if (!ehca_bmap_valid(ehca_bmap->top[top])) {
2341 ehca_bmap->top[top] =
2342 kmalloc(sizeof(struct ehca_top_bmap), GFP_KERNEL);
2343 if (!ehca_bmap->top[top])
2344 return -ENOMEM;
2345 /* Set map block to 0xFF according to EHCA_INVAL_ADDR */
2346 memset(ehca_bmap->top[top], 0xFF, EHCA_DIR_MAP_SIZE);
2347 }
2348 return ehca_init_top_bmap(ehca_bmap->top[top], dir);
2349}
2350
2351static inline int ehca_calc_index(unsigned long i, unsigned long s)
2352{
2353 return (i >> s) & EHCA_INDEX_MASK;
2354}
2355
2356void ehca_destroy_busmap(void)
2357{
2358 int top, dir;
2359
2360 if (!ehca_bmap)
2361 return;
2362
2363 for (top = 0; top < EHCA_MAP_ENTRIES; top++) {
2364 if (!ehca_bmap_valid(ehca_bmap->top[top]))
2365 continue;
2366 for (dir = 0; dir < EHCA_MAP_ENTRIES; dir++) {
2367 if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir]))
2368 continue;
2369
2370 kfree(ehca_bmap->top[top]->dir[dir]);
2371 }
2372
2373 kfree(ehca_bmap->top[top]);
2374 }
2375
2376 kfree(ehca_bmap);
2377 ehca_bmap = NULL;
2378}
2379
2380static int ehca_update_busmap(unsigned long pfn, unsigned long nr_pages)
2381{
2382 unsigned long i, start_section, end_section;
2383 int top, dir, idx;
2384
2385 if (!nr_pages)
2386 return 0;
2387
2388 if (!ehca_bmap) {
2389 ehca_bmap = kmalloc(sizeof(struct ehca_bmap), GFP_KERNEL);
2390 if (!ehca_bmap)
2391 return -ENOMEM;
2392 /* Set map block to 0xFF according to EHCA_INVAL_ADDR */
2393 memset(ehca_bmap, 0xFF, EHCA_TOP_MAP_SIZE);
2394 }
2395
2396 start_section = phys_to_abs(pfn * PAGE_SIZE) / EHCA_SECTSIZE;
2397 end_section = phys_to_abs((pfn + nr_pages) * PAGE_SIZE) / EHCA_SECTSIZE;
2398 for (i = start_section; i < end_section; i++) {
2399 int ret;
2400 top = ehca_calc_index(i, EHCA_TOP_INDEX_SHIFT);
2401 dir = ehca_calc_index(i, EHCA_DIR_INDEX_SHIFT);
2402 idx = i & EHCA_INDEX_MASK;
2403
2404 ret = ehca_init_bmap(ehca_bmap, top, dir);
2405 if (ret) {
2406 ehca_destroy_busmap();
2407 return ret;
2408 }
2409 ehca_bmap->top[top]->dir[dir]->ent[idx] = ehca_mr_len;
2410 ehca_mr_len += EHCA_SECTSIZE;
2411 }
2412 return 0;
2413}
2414
2415static int ehca_is_hugepage(unsigned long pfn)
2416{
2417 int page_order;
2418
2419 if (pfn & EHCA_HUGEPAGE_PFN_MASK)
2420 return 0;
2421
2422 page_order = compound_order(pfn_to_page(pfn));
2423 if (page_order + PAGE_SHIFT != EHCA_HUGEPAGESHIFT)
2424 return 0;
2425
2426 return 1;
2427}
2428
2429static int ehca_create_busmap_callback(unsigned long initial_pfn,
2430 unsigned long total_nr_pages, void *arg)
2431{
2432 int ret;
2433 unsigned long pfn, start_pfn, end_pfn, nr_pages;
2434
2435 if ((total_nr_pages * PAGE_SIZE) < EHCA_HUGEPAGE_SIZE)
2436 return ehca_update_busmap(initial_pfn, total_nr_pages);
2437
2438 /* Given chunk is >= 16GB -> check for hugepages */
2439 start_pfn = initial_pfn;
2440 end_pfn = initial_pfn + total_nr_pages;
2441 pfn = start_pfn;
2442
2443 while (pfn < end_pfn) {
2444 if (ehca_is_hugepage(pfn)) {
2445 /* Add mem found in front of the hugepage */
2446 nr_pages = pfn - start_pfn;
2447 ret = ehca_update_busmap(start_pfn, nr_pages);
2448 if (ret)
2449 return ret;
2450 /* Skip the hugepage */
2451 pfn += (EHCA_HUGEPAGE_SIZE / PAGE_SIZE);
2452 start_pfn = pfn;
2453 } else
2454 pfn += (EHCA_SECTSIZE / PAGE_SIZE);
2455 }
2456
2457 /* Add mem found behind the hugepage(s) */
2458 nr_pages = pfn - start_pfn;
2459 return ehca_update_busmap(start_pfn, nr_pages);
2460}
2461
2462int ehca_create_busmap(void)
2463{
2464 int ret;
2465
2466 ehca_mr_len = 0;
908eedc6 2467 ret = walk_system_ram_range(0, 1ULL << MAX_PHYSMEM_BITS, NULL,
0cf89dcd
HH		 2468 ehca_create_busmap_callback);
2469 return ret;
2470}
2471
2472static int ehca_reg_bmap_mr_rpages(struct ehca_shca *shca,
2473 struct ehca_mr *e_mr,
2474 struct ehca_mr_pginfo *pginfo)
2475{
2476 int top;
2477 u64 hret, *kpage;
2478
2479 kpage = ehca_alloc_fw_ctrlblock(GFP_KERNEL);
2480 if (!kpage) {
2481 ehca_err(&shca->ib_device, "kpage alloc failed");
2482 return -ENOMEM;
2483 }
2484 for (top = 0; top < EHCA_MAP_ENTRIES; top++) {
2485 if (!ehca_bmap_valid(ehca_bmap->top[top]))
2486 continue;
2487 hret = ehca_reg_mr_dir_sections(top, kpage, shca, e_mr, pginfo);
2488 if ((hret != H_PAGE_REGISTERED) && (hret != H_SUCCESS))
2489 break;
2490 }
2491
2492 ehca_free_fw_ctrlblock(kpage);
2493
2494 if (hret == H_SUCCESS)
2495 return 0; /* Everything is fine */
2496 else {
2497 ehca_err(&shca->ib_device, "ehca_reg_bmap_mr_rpages failed, "
2498 "h_ret=%lli e_mr=%p top=%x lkey=%x "
2499 "hca_hndl=%llx mr_hndl=%llx", hret, e_mr, top,
2500 e_mr->ib.ib_mr.lkey,
2501 shca->ipz_hca_handle.handle,
2502 e_mr->ipz_mr_handle.handle);
2503 return ehca2ib_return_code(hret);
2504 }
2505}
2506
2507static u64 ehca_map_vaddr(void *caddr)
2508{
2509 int top, dir, idx;
2510 unsigned long abs_addr, offset;
2511 u64 entry;
2512
2513 if (!ehca_bmap)
2514 return EHCA_INVAL_ADDR;
2515
2516 abs_addr = virt_to_abs(caddr);
2517 top = ehca_calc_index(abs_addr, EHCA_TOP_INDEX_SHIFT + EHCA_SECTSHIFT);
2518 if (!ehca_bmap_valid(ehca_bmap->top[top]))
2519 return EHCA_INVAL_ADDR;
2520
2521 dir = ehca_calc_index(abs_addr, EHCA_DIR_INDEX_SHIFT + EHCA_SECTSHIFT);
2522 if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir]))
2523 return EHCA_INVAL_ADDR;
2524
2525 idx = ehca_calc_index(abs_addr, EHCA_SECTSHIFT);
2526
2527 entry = ehca_bmap->top[top]->dir[dir]->ent[idx];
2528 if (ehca_bmap_valid(entry)) {
2529 offset = (unsigned long)caddr & (EHCA_SECTSIZE - 1);
2530 return entry | offset;
2531 } else
2532 return EHCA_INVAL_ADDR;
2533}
2534
2535static int ehca_dma_mapping_error(struct ib_device *dev, u64 dma_addr)
2536{
2537 return dma_addr == EHCA_INVAL_ADDR;
2538}
2539
2540static u64 ehca_dma_map_single(struct ib_device *dev, void *cpu_addr,
2541 size_t size, enum dma_data_direction direction)
2542{
2543 if (cpu_addr)
2544 return ehca_map_vaddr(cpu_addr);
2545 else
2546 return EHCA_INVAL_ADDR;
2547}
2548
2549static void ehca_dma_unmap_single(struct ib_device *dev, u64 addr, size_t size,
2550 enum dma_data_direction direction)
2551{
2552 /* This is only a stub; nothing to be done here */
2553}
2554
2555static u64 ehca_dma_map_page(struct ib_device *dev, struct page *page,
2556 unsigned long offset, size_t size,
2557 enum dma_data_direction direction)
2558{
2559 u64 addr;
2560
2561 if (offset + size > PAGE_SIZE)
2562 return EHCA_INVAL_ADDR;
2563
2564 addr = ehca_map_vaddr(page_address(page));
2565 if (!ehca_dma_mapping_error(dev, addr))
2566 addr += offset;
2567
2568 return addr;
2569}
2570
2571static void ehca_dma_unmap_page(struct ib_device *dev, u64 addr, size_t size,
2572 enum dma_data_direction direction)
2573{
2574 /* This is only a stub; nothing to be done here */
2575}
2576
2577static int ehca_dma_map_sg(struct ib_device *dev, struct scatterlist *sgl,
2578 int nents, enum dma_data_direction direction)
2579{
2580 struct scatterlist *sg;
2581 int i;
2582
2583 for_each_sg(sgl, sg, nents, i) {
2584 u64 addr;
2585 addr = ehca_map_vaddr(sg_virt(sg));
2586 if (ehca_dma_mapping_error(dev, addr))
2587 return 0;
2588
2589 sg->dma_address = addr;
2590 sg->dma_length = sg->length;
2591 }
2592 return nents;
2593}
2594
2595static void ehca_dma_unmap_sg(struct ib_device *dev, struct scatterlist *sg,
2596 int nents, enum dma_data_direction direction)
2597{
2598 /* This is only a stub; nothing to be done here */
2599}
2600
2601static u64 ehca_dma_address(struct ib_device *dev, struct scatterlist *sg)
2602{
2603 return sg->dma_address;
2604}
2605
2606static unsigned int ehca_dma_len(struct ib_device *dev, struct scatterlist *sg)
2607{
2608 return sg->length;
2609}
2610
2611static void ehca_dma_sync_single_for_cpu(struct ib_device *dev, u64 addr,
2612 size_t size,
2613 enum dma_data_direction dir)
2614{
2615 dma_sync_single_for_cpu(dev->dma_device, addr, size, dir);
2616}
2617
2618static void ehca_dma_sync_single_for_device(struct ib_device *dev, u64 addr,
2619 size_t size,
2620 enum dma_data_direction dir)
2621{
2622 dma_sync_single_for_device(dev->dma_device, addr, size, dir);
2623}
2624
2625static void *ehca_dma_alloc_coherent(struct ib_device *dev, size_t size,
2626 u64 *dma_handle, gfp_t flag)
2627{
2628 struct page *p;
2629 void *addr = NULL;
2630 u64 dma_addr;
2631
2632 p = alloc_pages(flag, get_order(size));
2633 if (p) {
2634 addr = page_address(p);
2635 dma_addr = ehca_map_vaddr(addr);
2636 if (ehca_dma_mapping_error(dev, dma_addr)) {
2637 free_pages((unsigned long)addr, get_order(size));
2638 return NULL;
2639 }
2640 if (dma_handle)
2641 *dma_handle = dma_addr;
2642 return addr;
2643 }
2644 return NULL;
2645}
2646
2647static void ehca_dma_free_coherent(struct ib_device *dev, size_t size,
2648 void *cpu_addr, u64 dma_handle)
2649{
2650 if (cpu_addr && size)
2651 free_pages((unsigned long)cpu_addr, get_order(size));
2652}
2653
2654
2655struct ib_dma_mapping_ops ehca_dma_mapping_ops = {
2656 .mapping_error = ehca_dma_mapping_error,
2657 .map_single = ehca_dma_map_single,
2658 .unmap_single = ehca_dma_unmap_single,
2659 .map_page = ehca_dma_map_page,
2660 .unmap_page = ehca_dma_unmap_page,
2661 .map_sg = ehca_dma_map_sg,
2662 .unmap_sg = ehca_dma_unmap_sg,
2663 .dma_address = ehca_dma_address,
2664 .dma_len = ehca_dma_len,
2665 .sync_single_for_cpu = ehca_dma_sync_single_for_cpu,
2666 .sync_single_for_device = ehca_dma_sync_single_for_device,
2667 .alloc_coherent = ehca_dma_alloc_coherent,
2668 .free_coherent = ehca_dma_free_coherent,
2669};
Clone of davem's net-next-2.6 tree