| /* |
| * IBM eServer eHCA Infiniband device driver for Linux on POWER |
| * |
| * MR/MW functions |
| * |
| * Authors: Dietmar Decker <ddecker@de.ibm.com> |
| * Christoph Raisch <raisch@de.ibm.com> |
| * Hoang-Nam Nguyen <hnguyen@de.ibm.com> |
| * |
| * Copyright (c) 2005 IBM Corporation |
| * |
| * All rights reserved. |
| * |
| * This source code is distributed under a dual license of GPL v2.0 and OpenIB |
| * BSD. |
| * |
| * OpenIB BSD License |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are met: |
| * |
| * Redistributions of source code must retain the above copyright notice, this |
| * list of conditions and the following disclaimer. |
| * |
| * Redistributions in binary form must reproduce the above copyright notice, |
| * this list of conditions and the following disclaimer in the documentation |
| * and/or other materials |
| * provided with the distribution. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER |
| * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| * POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| #include <linux/slab.h> |
| #include <rdma/ib_umem.h> |
| |
| #include "ehca_iverbs.h" |
| #include "ehca_mrmw.h" |
| #include "hcp_if.h" |
| #include "hipz_hw.h" |
| |
| #define NUM_CHUNKS(length, chunk_size) \ |
| (((length) + (chunk_size - 1)) / (chunk_size)) |
| |
| /* max number of rpages (per hcall register_rpages) */ |
| #define MAX_RPAGES 512 |
| |
| /* DMEM toleration management */ |
| #define EHCA_SECTSHIFT SECTION_SIZE_BITS |
| #define EHCA_SECTSIZE (1UL << EHCA_SECTSHIFT) |
| #define EHCA_HUGEPAGESHIFT 34 |
| #define EHCA_HUGEPAGE_SIZE (1UL << EHCA_HUGEPAGESHIFT) |
| #define EHCA_HUGEPAGE_PFN_MASK ((EHCA_HUGEPAGE_SIZE - 1) >> PAGE_SHIFT) |
| #define EHCA_INVAL_ADDR 0xFFFFFFFFFFFFFFFFULL |
| #define EHCA_DIR_INDEX_SHIFT 13 /* 8k Entries in 64k block */ |
| #define EHCA_TOP_INDEX_SHIFT (EHCA_DIR_INDEX_SHIFT * 2) |
| #define EHCA_MAP_ENTRIES (1 << EHCA_DIR_INDEX_SHIFT) |
| #define EHCA_TOP_MAP_SIZE (0x10000) /* currently fixed map size */ |
| #define EHCA_DIR_MAP_SIZE (0x10000) |
| #define EHCA_ENT_MAP_SIZE (0x10000) |
| #define EHCA_INDEX_MASK (EHCA_MAP_ENTRIES - 1) |
| |
| static unsigned long ehca_mr_len; |
| |
| /* |
| * Memory map data structures |
| */ |
| struct ehca_dir_bmap { |
| u64 ent[EHCA_MAP_ENTRIES]; |
| }; |
| struct ehca_top_bmap { |
| struct ehca_dir_bmap *dir[EHCA_MAP_ENTRIES]; |
| }; |
| struct ehca_bmap { |
| struct ehca_top_bmap *top[EHCA_MAP_ENTRIES]; |
| }; |
| |
| static struct ehca_bmap *ehca_bmap; |
| |
| static struct kmem_cache *mr_cache; |
| static struct kmem_cache *mw_cache; |
| |
| enum ehca_mr_pgsize { |
| EHCA_MR_PGSIZE4K = 0x1000L, |
| EHCA_MR_PGSIZE64K = 0x10000L, |
| EHCA_MR_PGSIZE1M = 0x100000L, |
| EHCA_MR_PGSIZE16M = 0x1000000L |
| }; |
| |
| #define EHCA_MR_PGSHIFT4K 12 |
| #define EHCA_MR_PGSHIFT64K 16 |
| #define EHCA_MR_PGSHIFT1M 20 |
| #define EHCA_MR_PGSHIFT16M 24 |
| |
| static u64 ehca_map_vaddr(void *caddr); |
| |
| static u32 ehca_encode_hwpage_size(u32 pgsize) |
| { |
| int log = ilog2(pgsize); |
| WARN_ON(log < 12 || log > 24 || log & 3); |
| return (log - 12) / 4; |
| } |
| |
| static u64 ehca_get_max_hwpage_size(struct ehca_shca *shca) |
| { |
| return rounddown_pow_of_two(shca->hca_cap_mr_pgsize); |
| } |
| |
| static struct ehca_mr *ehca_mr_new(void) |
| { |
| struct ehca_mr *me; |
| |
| me = kmem_cache_zalloc(mr_cache, GFP_KERNEL); |
| if (me) |
| spin_lock_init(&me->mrlock); |
| else |
| ehca_gen_err("alloc failed"); |
| |
| return me; |
| } |
| |
| static void ehca_mr_delete(struct ehca_mr *me) |
| { |
| kmem_cache_free(mr_cache, me); |
| } |
| |
| static struct ehca_mw *ehca_mw_new(void) |
| { |
| struct ehca_mw *me; |
| |
| me = kmem_cache_zalloc(mw_cache, GFP_KERNEL); |
| if (me) |
| spin_lock_init(&me->mwlock); |
| else |
| ehca_gen_err("alloc failed"); |
| |
| return me; |
| } |
| |
| static void ehca_mw_delete(struct ehca_mw *me) |
| { |
| kmem_cache_free(mw_cache, me); |
| } |
| |
| /*----------------------------------------------------------------------*/ |
| |
| struct ib_mr *ehca_get_dma_mr(struct ib_pd *pd, int mr_access_flags) |
| { |
| struct ib_mr *ib_mr; |
| int ret; |
| struct ehca_mr *e_maxmr; |
| struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd); |
| struct ehca_shca *shca = |
| container_of(pd->device, struct ehca_shca, ib_device); |
| |
| if (shca->maxmr) { |
| e_maxmr = ehca_mr_new(); |
| if (!e_maxmr) { |
| ehca_err(&shca->ib_device, "out of memory"); |
| ib_mr = ERR_PTR(-ENOMEM); |
| goto get_dma_mr_exit0; |
| } |
| |
| ret = ehca_reg_maxmr(shca, e_maxmr, |
| (void *)ehca_map_vaddr((void *)(KERNELBASE + PHYSICAL_START)), |
| mr_access_flags, e_pd, |
| &e_maxmr->ib.ib_mr.lkey, |
| &e_maxmr->ib.ib_mr.rkey); |
| if (ret) { |
| ehca_mr_delete(e_maxmr); |
| ib_mr = ERR_PTR(ret); |
| goto get_dma_mr_exit0; |
| } |
| ib_mr = &e_maxmr->ib.ib_mr; |
| } else { |
| ehca_err(&shca->ib_device, "no internal max-MR exist!"); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto get_dma_mr_exit0; |
| } |
| |
| get_dma_mr_exit0: |
| if (IS_ERR(ib_mr)) |
| ehca_err(&shca->ib_device, "h_ret=%li pd=%p mr_access_flags=%x", |
| PTR_ERR(ib_mr), pd, mr_access_flags); |
| return ib_mr; |
| } /* end ehca_get_dma_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| struct ib_mr *ehca_reg_phys_mr(struct ib_pd *pd, |
| struct ib_phys_buf *phys_buf_array, |
| int num_phys_buf, |
| int mr_access_flags, |
| u64 *iova_start) |
| { |
| struct ib_mr *ib_mr; |
| int ret; |
| struct ehca_mr *e_mr; |
| struct ehca_shca *shca = |
| container_of(pd->device, struct ehca_shca, ib_device); |
| struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd); |
| |
| u64 size; |
| |
| if ((num_phys_buf <= 0) || !phys_buf_array) { |
| ehca_err(pd->device, "bad input values: num_phys_buf=%x " |
| "phys_buf_array=%p", num_phys_buf, phys_buf_array); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto reg_phys_mr_exit0; |
| } |
| if (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) || |
| ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE))) { |
| /* |
| * Remote Write Access requires Local Write Access |
| * Remote Atomic Access requires Local Write Access |
| */ |
| ehca_err(pd->device, "bad input values: mr_access_flags=%x", |
| mr_access_flags); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto reg_phys_mr_exit0; |
| } |
| |
| /* check physical buffer list and calculate size */ |
| ret = ehca_mr_chk_buf_and_calc_size(phys_buf_array, num_phys_buf, |
| iova_start, &size); |
| if (ret) { |
| ib_mr = ERR_PTR(ret); |
| goto reg_phys_mr_exit0; |
| } |
| if ((size == 0) || |
| (((u64)iova_start + size) < (u64)iova_start)) { |
| ehca_err(pd->device, "bad input values: size=%llx iova_start=%p", |
| size, iova_start); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto reg_phys_mr_exit0; |
| } |
| |
| e_mr = ehca_mr_new(); |
| if (!e_mr) { |
| ehca_err(pd->device, "out of memory"); |
| ib_mr = ERR_PTR(-ENOMEM); |
| goto reg_phys_mr_exit0; |
| } |
| |
| /* register MR on HCA */ |
| if (ehca_mr_is_maxmr(size, iova_start)) { |
| e_mr->flags |= EHCA_MR_FLAG_MAXMR; |
| ret = ehca_reg_maxmr(shca, e_mr, iova_start, mr_access_flags, |
| e_pd, &e_mr->ib.ib_mr.lkey, |
| &e_mr->ib.ib_mr.rkey); |
| if (ret) { |
| ib_mr = ERR_PTR(ret); |
| goto reg_phys_mr_exit1; |
| } |
| } else { |
| struct ehca_mr_pginfo pginfo; |
| u32 num_kpages; |
| u32 num_hwpages; |
| u64 hw_pgsize; |
| |
| num_kpages = NUM_CHUNKS(((u64)iova_start % PAGE_SIZE) + size, |
| PAGE_SIZE); |
| /* for kernel space we try most possible pgsize */ |
| hw_pgsize = ehca_get_max_hwpage_size(shca); |
| num_hwpages = NUM_CHUNKS(((u64)iova_start % hw_pgsize) + size, |
| hw_pgsize); |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.type = EHCA_MR_PGI_PHYS; |
| pginfo.num_kpages = num_kpages; |
| pginfo.hwpage_size = hw_pgsize; |
| pginfo.num_hwpages = num_hwpages; |
| pginfo.u.phy.num_phys_buf = num_phys_buf; |
| pginfo.u.phy.phys_buf_array = phys_buf_array; |
| pginfo.next_hwpage = |
| ((u64)iova_start & ~PAGE_MASK) / hw_pgsize; |
| |
| ret = ehca_reg_mr(shca, e_mr, iova_start, size, mr_access_flags, |
| e_pd, &pginfo, &e_mr->ib.ib_mr.lkey, |
| &e_mr->ib.ib_mr.rkey, EHCA_REG_MR); |
| if (ret) { |
| ib_mr = ERR_PTR(ret); |
| goto reg_phys_mr_exit1; |
| } |
| } |
| |
| /* successful registration of all pages */ |
| return &e_mr->ib.ib_mr; |
| |
| reg_phys_mr_exit1: |
| ehca_mr_delete(e_mr); |
| reg_phys_mr_exit0: |
| if (IS_ERR(ib_mr)) |
| ehca_err(pd->device, "h_ret=%li pd=%p phys_buf_array=%p " |
| "num_phys_buf=%x mr_access_flags=%x iova_start=%p", |
| PTR_ERR(ib_mr), pd, phys_buf_array, |
| num_phys_buf, mr_access_flags, iova_start); |
| return ib_mr; |
| } /* end ehca_reg_phys_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| struct ib_mr *ehca_reg_user_mr(struct ib_pd *pd, u64 start, u64 length, |
| u64 virt, int mr_access_flags, |
| struct ib_udata *udata) |
| { |
| struct ib_mr *ib_mr; |
| struct ehca_mr *e_mr; |
| struct ehca_shca *shca = |
| container_of(pd->device, struct ehca_shca, ib_device); |
| struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd); |
| struct ehca_mr_pginfo pginfo; |
| int ret, page_shift; |
| u32 num_kpages; |
| u32 num_hwpages; |
| u64 hwpage_size; |
| |
| if (!pd) { |
| ehca_gen_err("bad pd=%p", pd); |
| return ERR_PTR(-EFAULT); |
| } |
| |
| if (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) || |
| ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE))) { |
| /* |
| * Remote Write Access requires Local Write Access |
| * Remote Atomic Access requires Local Write Access |
| */ |
| ehca_err(pd->device, "bad input values: mr_access_flags=%x", |
| mr_access_flags); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto reg_user_mr_exit0; |
| } |
| |
| if (length == 0 || virt + length < virt) { |
| ehca_err(pd->device, "bad input values: length=%llx " |
| "virt_base=%llx", length, virt); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto reg_user_mr_exit0; |
| } |
| |
| e_mr = ehca_mr_new(); |
| if (!e_mr) { |
| ehca_err(pd->device, "out of memory"); |
| ib_mr = ERR_PTR(-ENOMEM); |
| goto reg_user_mr_exit0; |
| } |
| |
| e_mr->umem = ib_umem_get(pd->uobject->context, start, length, |
| mr_access_flags, 0); |
| if (IS_ERR(e_mr->umem)) { |
| ib_mr = (void *)e_mr->umem; |
| goto reg_user_mr_exit1; |
| } |
| |
| if (e_mr->umem->page_size != PAGE_SIZE) { |
| ehca_err(pd->device, "page size not supported, " |
| "e_mr->umem->page_size=%x", e_mr->umem->page_size); |
| ib_mr = ERR_PTR(-EINVAL); |
| goto reg_user_mr_exit2; |
| } |
| |
| /* determine number of MR pages */ |
| num_kpages = NUM_CHUNKS((virt % PAGE_SIZE) + length, PAGE_SIZE); |
| /* select proper hw_pgsize */ |
| page_shift = PAGE_SHIFT; |
| if (e_mr->umem->hugetlb) { |
| /* determine page_shift, clamp between 4K and 16M */ |
| page_shift = (fls64(length - 1) + 3) & ~3; |
| page_shift = min(max(page_shift, EHCA_MR_PGSHIFT4K), |
| EHCA_MR_PGSHIFT16M); |
| } |
| hwpage_size = 1UL << page_shift; |
| |
| /* now that we have the desired page size, shift until it's |
| * supported, too. 4K is always supported, so this terminates. |
| */ |
| while (!(hwpage_size & shca->hca_cap_mr_pgsize)) |
| hwpage_size >>= 4; |
| |
| reg_user_mr_fallback: |
| num_hwpages = NUM_CHUNKS((virt % hwpage_size) + length, hwpage_size); |
| /* register MR on HCA */ |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.type = EHCA_MR_PGI_USER; |
| pginfo.hwpage_size = hwpage_size; |
| pginfo.num_kpages = num_kpages; |
| pginfo.num_hwpages = num_hwpages; |
| pginfo.u.usr.region = e_mr->umem; |
| pginfo.next_hwpage = e_mr->umem->offset / hwpage_size; |
| pginfo.u.usr.next_sg = pginfo.u.usr.region->sg_head.sgl; |
| ret = ehca_reg_mr(shca, e_mr, (u64 *)virt, length, mr_access_flags, |
| e_pd, &pginfo, &e_mr->ib.ib_mr.lkey, |
| &e_mr->ib.ib_mr.rkey, EHCA_REG_MR); |
| if (ret == -EINVAL && pginfo.hwpage_size > PAGE_SIZE) { |
| ehca_warn(pd->device, "failed to register mr " |
| "with hwpage_size=%llx", hwpage_size); |
| ehca_info(pd->device, "try to register mr with " |
| "kpage_size=%lx", PAGE_SIZE); |
| /* |
| * this means kpages are not contiguous for a hw page |
| * try kernel page size as fallback solution |
| */ |
| hwpage_size = PAGE_SIZE; |
| goto reg_user_mr_fallback; |
| } |
| if (ret) { |
| ib_mr = ERR_PTR(ret); |
| goto reg_user_mr_exit2; |
| } |
| |
| /* successful registration of all pages */ |
| return &e_mr->ib.ib_mr; |
| |
| reg_user_mr_exit2: |
| ib_umem_release(e_mr->umem); |
| reg_user_mr_exit1: |
| ehca_mr_delete(e_mr); |
| reg_user_mr_exit0: |
| if (IS_ERR(ib_mr)) |
| ehca_err(pd->device, "rc=%li pd=%p mr_access_flags=%x udata=%p", |
| PTR_ERR(ib_mr), pd, mr_access_flags, udata); |
| return ib_mr; |
| } /* end ehca_reg_user_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_rereg_phys_mr(struct ib_mr *mr, |
| int mr_rereg_mask, |
| struct ib_pd *pd, |
| struct ib_phys_buf *phys_buf_array, |
| int num_phys_buf, |
| int mr_access_flags, |
| u64 *iova_start) |
| { |
| int ret; |
| |
| struct ehca_shca *shca = |
| container_of(mr->device, struct ehca_shca, ib_device); |
| struct ehca_mr *e_mr = container_of(mr, struct ehca_mr, ib.ib_mr); |
| u64 new_size; |
| u64 *new_start; |
| u32 new_acl; |
| struct ehca_pd *new_pd; |
| u32 tmp_lkey, tmp_rkey; |
| unsigned long sl_flags; |
| u32 num_kpages = 0; |
| u32 num_hwpages = 0; |
| struct ehca_mr_pginfo pginfo; |
| |
| if (!(mr_rereg_mask & IB_MR_REREG_TRANS)) { |
| /* TODO not supported, because PHYP rereg hCall needs pages */ |
| ehca_err(mr->device, "rereg without IB_MR_REREG_TRANS not " |
| "supported yet, mr_rereg_mask=%x", mr_rereg_mask); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| |
| if (mr_rereg_mask & IB_MR_REREG_PD) { |
| if (!pd) { |
| ehca_err(mr->device, "rereg with bad pd, pd=%p " |
| "mr_rereg_mask=%x", pd, mr_rereg_mask); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| } |
| |
| if ((mr_rereg_mask & |
| ~(IB_MR_REREG_TRANS | IB_MR_REREG_PD | IB_MR_REREG_ACCESS)) || |
| (mr_rereg_mask == 0)) { |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| |
| /* check other parameters */ |
| if (e_mr == shca->maxmr) { |
| /* should be impossible, however reject to be sure */ |
| ehca_err(mr->device, "rereg internal max-MR impossible, mr=%p " |
| "shca->maxmr=%p mr->lkey=%x", |
| mr, shca->maxmr, mr->lkey); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| if (mr_rereg_mask & IB_MR_REREG_TRANS) { /* transl., i.e. addr/size */ |
| if (e_mr->flags & EHCA_MR_FLAG_FMR) { |
| ehca_err(mr->device, "not supported for FMR, mr=%p " |
| "flags=%x", mr, e_mr->flags); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| if (!phys_buf_array || num_phys_buf <= 0) { |
| ehca_err(mr->device, "bad input values mr_rereg_mask=%x" |
| " phys_buf_array=%p num_phys_buf=%x", |
| mr_rereg_mask, phys_buf_array, num_phys_buf); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| } |
| if ((mr_rereg_mask & IB_MR_REREG_ACCESS) && /* change ACL */ |
| (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) || |
| ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)))) { |
| /* |
| * Remote Write Access requires Local Write Access |
| * Remote Atomic Access requires Local Write Access |
| */ |
| ehca_err(mr->device, "bad input values: mr_rereg_mask=%x " |
| "mr_access_flags=%x", mr_rereg_mask, mr_access_flags); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit0; |
| } |
| |
| /* set requested values dependent on rereg request */ |
| spin_lock_irqsave(&e_mr->mrlock, sl_flags); |
| new_start = e_mr->start; |
| new_size = e_mr->size; |
| new_acl = e_mr->acl; |
| new_pd = container_of(mr->pd, struct ehca_pd, ib_pd); |
| |
| if (mr_rereg_mask & IB_MR_REREG_TRANS) { |
| u64 hw_pgsize = ehca_get_max_hwpage_size(shca); |
| |
| new_start = iova_start; /* change address */ |
| /* check physical buffer list and calculate size */ |
| ret = ehca_mr_chk_buf_and_calc_size(phys_buf_array, |
| num_phys_buf, iova_start, |
| &new_size); |
| if (ret) |
| goto rereg_phys_mr_exit1; |
| if ((new_size == 0) || |
| (((u64)iova_start + new_size) < (u64)iova_start)) { |
| ehca_err(mr->device, "bad input values: new_size=%llx " |
| "iova_start=%p", new_size, iova_start); |
| ret = -EINVAL; |
| goto rereg_phys_mr_exit1; |
| } |
| num_kpages = NUM_CHUNKS(((u64)new_start % PAGE_SIZE) + |
| new_size, PAGE_SIZE); |
| num_hwpages = NUM_CHUNKS(((u64)new_start % hw_pgsize) + |
| new_size, hw_pgsize); |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.type = EHCA_MR_PGI_PHYS; |
| pginfo.num_kpages = num_kpages; |
| pginfo.hwpage_size = hw_pgsize; |
| pginfo.num_hwpages = num_hwpages; |
| pginfo.u.phy.num_phys_buf = num_phys_buf; |
| pginfo.u.phy.phys_buf_array = phys_buf_array; |
| pginfo.next_hwpage = |
| ((u64)iova_start & ~PAGE_MASK) / hw_pgsize; |
| } |
| if (mr_rereg_mask & IB_MR_REREG_ACCESS) |
| new_acl = mr_access_flags; |
| if (mr_rereg_mask & IB_MR_REREG_PD) |
| new_pd = container_of(pd, struct ehca_pd, ib_pd); |
| |
| ret = ehca_rereg_mr(shca, e_mr, new_start, new_size, new_acl, |
| new_pd, &pginfo, &tmp_lkey, &tmp_rkey); |
| if (ret) |
| goto rereg_phys_mr_exit1; |
| |
| /* successful reregistration */ |
| if (mr_rereg_mask & IB_MR_REREG_PD) |
| mr->pd = pd; |
| mr->lkey = tmp_lkey; |
| mr->rkey = tmp_rkey; |
| |
| rereg_phys_mr_exit1: |
| spin_unlock_irqrestore(&e_mr->mrlock, sl_flags); |
| rereg_phys_mr_exit0: |
| if (ret) |
| ehca_err(mr->device, "ret=%i mr=%p mr_rereg_mask=%x pd=%p " |
| "phys_buf_array=%p num_phys_buf=%x mr_access_flags=%x " |
| "iova_start=%p", |
| ret, mr, mr_rereg_mask, pd, phys_buf_array, |
| num_phys_buf, mr_access_flags, iova_start); |
| return ret; |
| } /* end ehca_rereg_phys_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_query_mr(struct ib_mr *mr, struct ib_mr_attr *mr_attr) |
| { |
| int ret = 0; |
| u64 h_ret; |
| struct ehca_shca *shca = |
| container_of(mr->device, struct ehca_shca, ib_device); |
| struct ehca_mr *e_mr = container_of(mr, struct ehca_mr, ib.ib_mr); |
| unsigned long sl_flags; |
| struct ehca_mr_hipzout_parms hipzout; |
| |
| if ((e_mr->flags & EHCA_MR_FLAG_FMR)) { |
| ehca_err(mr->device, "not supported for FMR, mr=%p e_mr=%p " |
| "e_mr->flags=%x", mr, e_mr, e_mr->flags); |
| ret = -EINVAL; |
| goto query_mr_exit0; |
| } |
| |
| memset(mr_attr, 0, sizeof(struct ib_mr_attr)); |
| spin_lock_irqsave(&e_mr->mrlock, sl_flags); |
| |
| h_ret = hipz_h_query_mr(shca->ipz_hca_handle, e_mr, &hipzout); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(mr->device, "hipz_mr_query failed, h_ret=%lli mr=%p " |
| "hca_hndl=%llx mr_hndl=%llx lkey=%x", |
| h_ret, mr, shca->ipz_hca_handle.handle, |
| e_mr->ipz_mr_handle.handle, mr->lkey); |
| ret = ehca2ib_return_code(h_ret); |
| goto query_mr_exit1; |
| } |
| mr_attr->pd = mr->pd; |
| mr_attr->device_virt_addr = hipzout.vaddr; |
| mr_attr->size = hipzout.len; |
| mr_attr->lkey = hipzout.lkey; |
| mr_attr->rkey = hipzout.rkey; |
| ehca_mrmw_reverse_map_acl(&hipzout.acl, &mr_attr->mr_access_flags); |
| |
| query_mr_exit1: |
| spin_unlock_irqrestore(&e_mr->mrlock, sl_flags); |
| query_mr_exit0: |
| if (ret) |
| ehca_err(mr->device, "ret=%i mr=%p mr_attr=%p", |
| ret, mr, mr_attr); |
| return ret; |
| } /* end ehca_query_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_dereg_mr(struct ib_mr *mr) |
| { |
| int ret = 0; |
| u64 h_ret; |
| struct ehca_shca *shca = |
| container_of(mr->device, struct ehca_shca, ib_device); |
| struct ehca_mr *e_mr = container_of(mr, struct ehca_mr, ib.ib_mr); |
| |
| if ((e_mr->flags & EHCA_MR_FLAG_FMR)) { |
| ehca_err(mr->device, "not supported for FMR, mr=%p e_mr=%p " |
| "e_mr->flags=%x", mr, e_mr, e_mr->flags); |
| ret = -EINVAL; |
| goto dereg_mr_exit0; |
| } else if (e_mr == shca->maxmr) { |
| /* should be impossible, however reject to be sure */ |
| ehca_err(mr->device, "dereg internal max-MR impossible, mr=%p " |
| "shca->maxmr=%p mr->lkey=%x", |
| mr, shca->maxmr, mr->lkey); |
| ret = -EINVAL; |
| goto dereg_mr_exit0; |
| } |
| |
| /* TODO: BUSY: MR still has bound window(s) */ |
| h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_mr); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(mr->device, "hipz_free_mr failed, h_ret=%lli shca=%p " |
| "e_mr=%p hca_hndl=%llx mr_hndl=%llx mr->lkey=%x", |
| h_ret, shca, e_mr, shca->ipz_hca_handle.handle, |
| e_mr->ipz_mr_handle.handle, mr->lkey); |
| ret = ehca2ib_return_code(h_ret); |
| goto dereg_mr_exit0; |
| } |
| |
| if (e_mr->umem) |
| ib_umem_release(e_mr->umem); |
| |
| /* successful deregistration */ |
| ehca_mr_delete(e_mr); |
| |
| dereg_mr_exit0: |
| if (ret) |
| ehca_err(mr->device, "ret=%i mr=%p", ret, mr); |
| return ret; |
| } /* end ehca_dereg_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| struct ib_mw *ehca_alloc_mw(struct ib_pd *pd, enum ib_mw_type type) |
| { |
| struct ib_mw *ib_mw; |
| u64 h_ret; |
| struct ehca_mw *e_mw; |
| struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd); |
| struct ehca_shca *shca = |
| container_of(pd->device, struct ehca_shca, ib_device); |
| struct ehca_mw_hipzout_parms hipzout; |
| |
| if (type != IB_MW_TYPE_1) |
| return ERR_PTR(-EINVAL); |
| |
| e_mw = ehca_mw_new(); |
| if (!e_mw) { |
| ib_mw = ERR_PTR(-ENOMEM); |
| goto alloc_mw_exit0; |
| } |
| |
| h_ret = hipz_h_alloc_resource_mw(shca->ipz_hca_handle, e_mw, |
| e_pd->fw_pd, &hipzout); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(pd->device, "hipz_mw_allocate failed, h_ret=%lli " |
| "shca=%p hca_hndl=%llx mw=%p", |
| h_ret, shca, shca->ipz_hca_handle.handle, e_mw); |
| ib_mw = ERR_PTR(ehca2ib_return_code(h_ret)); |
| goto alloc_mw_exit1; |
| } |
| /* successful MW allocation */ |
| e_mw->ipz_mw_handle = hipzout.handle; |
| e_mw->ib_mw.rkey = hipzout.rkey; |
| return &e_mw->ib_mw; |
| |
| alloc_mw_exit1: |
| ehca_mw_delete(e_mw); |
| alloc_mw_exit0: |
| if (IS_ERR(ib_mw)) |
| ehca_err(pd->device, "h_ret=%li pd=%p", PTR_ERR(ib_mw), pd); |
| return ib_mw; |
| } /* end ehca_alloc_mw() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_bind_mw(struct ib_qp *qp, |
| struct ib_mw *mw, |
| struct ib_mw_bind *mw_bind) |
| { |
| /* TODO: not supported up to now */ |
| ehca_gen_err("bind MW currently not supported by HCAD"); |
| |
| return -EPERM; |
| } /* end ehca_bind_mw() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_dealloc_mw(struct ib_mw *mw) |
| { |
| u64 h_ret; |
| struct ehca_shca *shca = |
| container_of(mw->device, struct ehca_shca, ib_device); |
| struct ehca_mw *e_mw = container_of(mw, struct ehca_mw, ib_mw); |
| |
| h_ret = hipz_h_free_resource_mw(shca->ipz_hca_handle, e_mw); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(mw->device, "hipz_free_mw failed, h_ret=%lli shca=%p " |
| "mw=%p rkey=%x hca_hndl=%llx mw_hndl=%llx", |
| h_ret, shca, mw, mw->rkey, shca->ipz_hca_handle.handle, |
| e_mw->ipz_mw_handle.handle); |
| return ehca2ib_return_code(h_ret); |
| } |
| /* successful deallocation */ |
| ehca_mw_delete(e_mw); |
| return 0; |
| } /* end ehca_dealloc_mw() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| struct ib_fmr *ehca_alloc_fmr(struct ib_pd *pd, |
| int mr_access_flags, |
| struct ib_fmr_attr *fmr_attr) |
| { |
| struct ib_fmr *ib_fmr; |
| struct ehca_shca *shca = |
| container_of(pd->device, struct ehca_shca, ib_device); |
| struct ehca_pd *e_pd = container_of(pd, struct ehca_pd, ib_pd); |
| struct ehca_mr *e_fmr; |
| int ret; |
| u32 tmp_lkey, tmp_rkey; |
| struct ehca_mr_pginfo pginfo; |
| u64 hw_pgsize; |
| |
| /* check other parameters */ |
| if (((mr_access_flags & IB_ACCESS_REMOTE_WRITE) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE)) || |
| ((mr_access_flags & IB_ACCESS_REMOTE_ATOMIC) && |
| !(mr_access_flags & IB_ACCESS_LOCAL_WRITE))) { |
| /* |
| * Remote Write Access requires Local Write Access |
| * Remote Atomic Access requires Local Write Access |
| */ |
| ehca_err(pd->device, "bad input values: mr_access_flags=%x", |
| mr_access_flags); |
| ib_fmr = ERR_PTR(-EINVAL); |
| goto alloc_fmr_exit0; |
| } |
| if (mr_access_flags & IB_ACCESS_MW_BIND) { |
| ehca_err(pd->device, "bad input values: mr_access_flags=%x", |
| mr_access_flags); |
| ib_fmr = ERR_PTR(-EINVAL); |
| goto alloc_fmr_exit0; |
| } |
| if ((fmr_attr->max_pages == 0) || (fmr_attr->max_maps == 0)) { |
| ehca_err(pd->device, "bad input values: fmr_attr->max_pages=%x " |
| "fmr_attr->max_maps=%x fmr_attr->page_shift=%x", |
| fmr_attr->max_pages, fmr_attr->max_maps, |
| fmr_attr->page_shift); |
| ib_fmr = ERR_PTR(-EINVAL); |
| goto alloc_fmr_exit0; |
| } |
| |
| hw_pgsize = 1 << fmr_attr->page_shift; |
| if (!(hw_pgsize & shca->hca_cap_mr_pgsize)) { |
| ehca_err(pd->device, "unsupported fmr_attr->page_shift=%x", |
| fmr_attr->page_shift); |
| ib_fmr = ERR_PTR(-EINVAL); |
| goto alloc_fmr_exit0; |
| } |
| |
| e_fmr = ehca_mr_new(); |
| if (!e_fmr) { |
| ib_fmr = ERR_PTR(-ENOMEM); |
| goto alloc_fmr_exit0; |
| } |
| e_fmr->flags |= EHCA_MR_FLAG_FMR; |
| |
| /* register MR on HCA */ |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.hwpage_size = hw_pgsize; |
| /* |
| * pginfo.num_hwpages==0, ie register_rpages() will not be called |
| * but deferred to map_phys_fmr() |
| */ |
| ret = ehca_reg_mr(shca, e_fmr, NULL, |
| fmr_attr->max_pages * (1 << fmr_attr->page_shift), |
| mr_access_flags, e_pd, &pginfo, |
| &tmp_lkey, &tmp_rkey, EHCA_REG_MR); |
| if (ret) { |
| ib_fmr = ERR_PTR(ret); |
| goto alloc_fmr_exit1; |
| } |
| |
| /* successful */ |
| e_fmr->hwpage_size = hw_pgsize; |
| e_fmr->fmr_page_size = 1 << fmr_attr->page_shift; |
| e_fmr->fmr_max_pages = fmr_attr->max_pages; |
| e_fmr->fmr_max_maps = fmr_attr->max_maps; |
| e_fmr->fmr_map_cnt = 0; |
| return &e_fmr->ib.ib_fmr; |
| |
| alloc_fmr_exit1: |
| ehca_mr_delete(e_fmr); |
| alloc_fmr_exit0: |
| return ib_fmr; |
| } /* end ehca_alloc_fmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_map_phys_fmr(struct ib_fmr *fmr, |
| u64 *page_list, |
| int list_len, |
| u64 iova) |
| { |
| int ret; |
| struct ehca_shca *shca = |
| container_of(fmr->device, struct ehca_shca, ib_device); |
| struct ehca_mr *e_fmr = container_of(fmr, struct ehca_mr, ib.ib_fmr); |
| struct ehca_pd *e_pd = container_of(fmr->pd, struct ehca_pd, ib_pd); |
| struct ehca_mr_pginfo pginfo; |
| u32 tmp_lkey, tmp_rkey; |
| |
| if (!(e_fmr->flags & EHCA_MR_FLAG_FMR)) { |
| ehca_err(fmr->device, "not a FMR, e_fmr=%p e_fmr->flags=%x", |
| e_fmr, e_fmr->flags); |
| ret = -EINVAL; |
| goto map_phys_fmr_exit0; |
| } |
| ret = ehca_fmr_check_page_list(e_fmr, page_list, list_len); |
| if (ret) |
| goto map_phys_fmr_exit0; |
| if (iova % e_fmr->fmr_page_size) { |
| /* only whole-numbered pages */ |
| ehca_err(fmr->device, "bad iova, iova=%llx fmr_page_size=%x", |
| iova, e_fmr->fmr_page_size); |
| ret = -EINVAL; |
| goto map_phys_fmr_exit0; |
| } |
| if (e_fmr->fmr_map_cnt >= e_fmr->fmr_max_maps) { |
| /* HCAD does not limit the maps, however trace this anyway */ |
| ehca_info(fmr->device, "map limit exceeded, fmr=%p " |
| "e_fmr->fmr_map_cnt=%x e_fmr->fmr_max_maps=%x", |
| fmr, e_fmr->fmr_map_cnt, e_fmr->fmr_max_maps); |
| } |
| |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.type = EHCA_MR_PGI_FMR; |
| pginfo.num_kpages = list_len; |
| pginfo.hwpage_size = e_fmr->hwpage_size; |
| pginfo.num_hwpages = |
| list_len * e_fmr->fmr_page_size / pginfo.hwpage_size; |
| pginfo.u.fmr.page_list = page_list; |
| pginfo.next_hwpage = |
| (iova & (e_fmr->fmr_page_size-1)) / pginfo.hwpage_size; |
| pginfo.u.fmr.fmr_pgsize = e_fmr->fmr_page_size; |
| |
| ret = ehca_rereg_mr(shca, e_fmr, (u64 *)iova, |
| list_len * e_fmr->fmr_page_size, |
| e_fmr->acl, e_pd, &pginfo, &tmp_lkey, &tmp_rkey); |
| if (ret) |
| goto map_phys_fmr_exit0; |
| |
| /* successful reregistration */ |
| e_fmr->fmr_map_cnt++; |
| e_fmr->ib.ib_fmr.lkey = tmp_lkey; |
| e_fmr->ib.ib_fmr.rkey = tmp_rkey; |
| return 0; |
| |
| map_phys_fmr_exit0: |
| if (ret) |
| ehca_err(fmr->device, "ret=%i fmr=%p page_list=%p list_len=%x " |
| "iova=%llx", ret, fmr, page_list, list_len, iova); |
| return ret; |
| } /* end ehca_map_phys_fmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_unmap_fmr(struct list_head *fmr_list) |
| { |
| int ret = 0; |
| struct ib_fmr *ib_fmr; |
| struct ehca_shca *shca = NULL; |
| struct ehca_shca *prev_shca; |
| struct ehca_mr *e_fmr; |
| u32 num_fmr = 0; |
| u32 unmap_fmr_cnt = 0; |
| |
| /* check all FMR belong to same SHCA, and check internal flag */ |
| list_for_each_entry(ib_fmr, fmr_list, list) { |
| prev_shca = shca; |
| shca = container_of(ib_fmr->device, struct ehca_shca, |
| ib_device); |
| e_fmr = container_of(ib_fmr, struct ehca_mr, ib.ib_fmr); |
| if ((shca != prev_shca) && prev_shca) { |
| ehca_err(&shca->ib_device, "SHCA mismatch, shca=%p " |
| "prev_shca=%p e_fmr=%p", |
| shca, prev_shca, e_fmr); |
| ret = -EINVAL; |
| goto unmap_fmr_exit0; |
| } |
| if (!(e_fmr->flags & EHCA_MR_FLAG_FMR)) { |
| ehca_err(&shca->ib_device, "not a FMR, e_fmr=%p " |
| "e_fmr->flags=%x", e_fmr, e_fmr->flags); |
| ret = -EINVAL; |
| goto unmap_fmr_exit0; |
| } |
| num_fmr++; |
| } |
| |
| /* loop over all FMRs to unmap */ |
| list_for_each_entry(ib_fmr, fmr_list, list) { |
| unmap_fmr_cnt++; |
| e_fmr = container_of(ib_fmr, struct ehca_mr, ib.ib_fmr); |
| shca = container_of(ib_fmr->device, struct ehca_shca, |
| ib_device); |
| ret = ehca_unmap_one_fmr(shca, e_fmr); |
| if (ret) { |
| /* unmap failed, stop unmapping of rest of FMRs */ |
| ehca_err(&shca->ib_device, "unmap of one FMR failed, " |
| "stop rest, e_fmr=%p num_fmr=%x " |
| "unmap_fmr_cnt=%x lkey=%x", e_fmr, num_fmr, |
| unmap_fmr_cnt, e_fmr->ib.ib_fmr.lkey); |
| goto unmap_fmr_exit0; |
| } |
| } |
| |
| unmap_fmr_exit0: |
| if (ret) |
| ehca_gen_err("ret=%i fmr_list=%p num_fmr=%x unmap_fmr_cnt=%x", |
| ret, fmr_list, num_fmr, unmap_fmr_cnt); |
| return ret; |
| } /* end ehca_unmap_fmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_dealloc_fmr(struct ib_fmr *fmr) |
| { |
| int ret; |
| u64 h_ret; |
| struct ehca_shca *shca = |
| container_of(fmr->device, struct ehca_shca, ib_device); |
| struct ehca_mr *e_fmr = container_of(fmr, struct ehca_mr, ib.ib_fmr); |
| |
| if (!(e_fmr->flags & EHCA_MR_FLAG_FMR)) { |
| ehca_err(fmr->device, "not a FMR, e_fmr=%p e_fmr->flags=%x", |
| e_fmr, e_fmr->flags); |
| ret = -EINVAL; |
| goto free_fmr_exit0; |
| } |
| |
| h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_fmr); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(fmr->device, "hipz_free_mr failed, h_ret=%lli e_fmr=%p " |
| "hca_hndl=%llx fmr_hndl=%llx fmr->lkey=%x", |
| h_ret, e_fmr, shca->ipz_hca_handle.handle, |
| e_fmr->ipz_mr_handle.handle, fmr->lkey); |
| ret = ehca2ib_return_code(h_ret); |
| goto free_fmr_exit0; |
| } |
| /* successful deregistration */ |
| ehca_mr_delete(e_fmr); |
| return 0; |
| |
| free_fmr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i fmr=%p", ret, fmr); |
| return ret; |
| } /* end ehca_dealloc_fmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| static int ehca_reg_bmap_mr_rpages(struct ehca_shca *shca, |
| struct ehca_mr *e_mr, |
| struct ehca_mr_pginfo *pginfo); |
| |
| int ehca_reg_mr(struct ehca_shca *shca, |
| struct ehca_mr *e_mr, |
| u64 *iova_start, |
| u64 size, |
| int acl, |
| struct ehca_pd *e_pd, |
| struct ehca_mr_pginfo *pginfo, |
| u32 *lkey, /*OUT*/ |
| u32 *rkey, /*OUT*/ |
| enum ehca_reg_type reg_type) |
| { |
| int ret; |
| u64 h_ret; |
| u32 hipz_acl; |
| struct ehca_mr_hipzout_parms hipzout; |
| |
| ehca_mrmw_map_acl(acl, &hipz_acl); |
| ehca_mrmw_set_pgsize_hipz_acl(pginfo->hwpage_size, &hipz_acl); |
| if (ehca_use_hp_mr == 1) |
| hipz_acl |= 0x00000001; |
| |
| h_ret = hipz_h_alloc_resource_mr(shca->ipz_hca_handle, e_mr, |
| (u64)iova_start, size, hipz_acl, |
| e_pd->fw_pd, &hipzout); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "hipz_alloc_mr failed, h_ret=%lli " |
| "hca_hndl=%llx", h_ret, shca->ipz_hca_handle.handle); |
| ret = ehca2ib_return_code(h_ret); |
| goto ehca_reg_mr_exit0; |
| } |
| |
| e_mr->ipz_mr_handle = hipzout.handle; |
| |
| if (reg_type == EHCA_REG_BUSMAP_MR) |
| ret = ehca_reg_bmap_mr_rpages(shca, e_mr, pginfo); |
| else if (reg_type == EHCA_REG_MR) |
| ret = ehca_reg_mr_rpages(shca, e_mr, pginfo); |
| else |
| ret = -EINVAL; |
| |
| if (ret) |
| goto ehca_reg_mr_exit1; |
| |
| /* successful registration */ |
| e_mr->num_kpages = pginfo->num_kpages; |
| e_mr->num_hwpages = pginfo->num_hwpages; |
| e_mr->hwpage_size = pginfo->hwpage_size; |
| e_mr->start = iova_start; |
| e_mr->size = size; |
| e_mr->acl = acl; |
| *lkey = hipzout.lkey; |
| *rkey = hipzout.rkey; |
| return 0; |
| |
| ehca_reg_mr_exit1: |
| h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_mr); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "h_ret=%lli shca=%p e_mr=%p " |
| "iova_start=%p size=%llx acl=%x e_pd=%p lkey=%x " |
| "pginfo=%p num_kpages=%llx num_hwpages=%llx ret=%i", |
| h_ret, shca, e_mr, iova_start, size, acl, e_pd, |
| hipzout.lkey, pginfo, pginfo->num_kpages, |
| pginfo->num_hwpages, ret); |
| ehca_err(&shca->ib_device, "internal error in ehca_reg_mr, " |
| "not recoverable"); |
| } |
| ehca_reg_mr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i shca=%p e_mr=%p " |
| "iova_start=%p size=%llx acl=%x e_pd=%p pginfo=%p " |
| "num_kpages=%llx num_hwpages=%llx", |
| ret, shca, e_mr, iova_start, size, acl, e_pd, pginfo, |
| pginfo->num_kpages, pginfo->num_hwpages); |
| return ret; |
| } /* end ehca_reg_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_reg_mr_rpages(struct ehca_shca *shca, |
| struct ehca_mr *e_mr, |
| struct ehca_mr_pginfo *pginfo) |
| { |
| int ret = 0; |
| u64 h_ret; |
| u32 rnum; |
| u64 rpage; |
| u32 i; |
| u64 *kpage; |
| |
| if (!pginfo->num_hwpages) /* in case of fmr */ |
| return 0; |
| |
| kpage = ehca_alloc_fw_ctrlblock(GFP_KERNEL); |
| if (!kpage) { |
| ehca_err(&shca->ib_device, "kpage alloc failed"); |
| ret = -ENOMEM; |
| goto ehca_reg_mr_rpages_exit0; |
| } |
| |
| /* max MAX_RPAGES ehca mr pages per register call */ |
| for (i = 0; i < NUM_CHUNKS(pginfo->num_hwpages, MAX_RPAGES); i++) { |
| |
| if (i == NUM_CHUNKS(pginfo->num_hwpages, MAX_RPAGES) - 1) { |
| rnum = pginfo->num_hwpages % MAX_RPAGES; /* last shot */ |
| if (rnum == 0) |
| rnum = MAX_RPAGES; /* last shot is full */ |
| } else |
| rnum = MAX_RPAGES; |
| |
| ret = ehca_set_pagebuf(pginfo, rnum, kpage); |
| if (ret) { |
| ehca_err(&shca->ib_device, "ehca_set_pagebuf " |
| "bad rc, ret=%i rnum=%x kpage=%p", |
| ret, rnum, kpage); |
| goto ehca_reg_mr_rpages_exit1; |
| } |
| |
| if (rnum > 1) { |
| rpage = __pa(kpage); |
| if (!rpage) { |
| ehca_err(&shca->ib_device, "kpage=%p i=%x", |
| kpage, i); |
| ret = -EFAULT; |
| goto ehca_reg_mr_rpages_exit1; |
| } |
| } else |
| rpage = *kpage; |
| |
| h_ret = hipz_h_register_rpage_mr( |
| shca->ipz_hca_handle, e_mr, |
| ehca_encode_hwpage_size(pginfo->hwpage_size), |
| 0, rpage, rnum); |
| |
| if (i == NUM_CHUNKS(pginfo->num_hwpages, MAX_RPAGES) - 1) { |
| /* |
| * check for 'registration complete'==H_SUCCESS |
| * and for 'page registered'==H_PAGE_REGISTERED |
| */ |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "last " |
| "hipz_reg_rpage_mr failed, h_ret=%lli " |
| "e_mr=%p i=%x hca_hndl=%llx mr_hndl=%llx" |
| " lkey=%x", h_ret, e_mr, i, |
| shca->ipz_hca_handle.handle, |
| e_mr->ipz_mr_handle.handle, |
| e_mr->ib.ib_mr.lkey); |
| ret = ehca2ib_return_code(h_ret); |
| break; |
| } else |
| ret = 0; |
| } else if (h_ret != H_PAGE_REGISTERED) { |
| ehca_err(&shca->ib_device, "hipz_reg_rpage_mr failed, " |
| "h_ret=%lli e_mr=%p i=%x lkey=%x hca_hndl=%llx " |
| "mr_hndl=%llx", h_ret, e_mr, i, |
| e_mr->ib.ib_mr.lkey, |
| shca->ipz_hca_handle.handle, |
| e_mr->ipz_mr_handle.handle); |
| ret = ehca2ib_return_code(h_ret); |
| break; |
| } else |
| ret = 0; |
| } /* end for(i) */ |
| |
| |
| ehca_reg_mr_rpages_exit1: |
| ehca_free_fw_ctrlblock(kpage); |
| ehca_reg_mr_rpages_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i shca=%p e_mr=%p pginfo=%p " |
| "num_kpages=%llx num_hwpages=%llx", ret, shca, e_mr, |
| pginfo, pginfo->num_kpages, pginfo->num_hwpages); |
| return ret; |
| } /* end ehca_reg_mr_rpages() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| inline int ehca_rereg_mr_rereg1(struct ehca_shca *shca, |
| struct ehca_mr *e_mr, |
| u64 *iova_start, |
| u64 size, |
| u32 acl, |
| struct ehca_pd *e_pd, |
| struct ehca_mr_pginfo *pginfo, |
| u32 *lkey, /*OUT*/ |
| u32 *rkey) /*OUT*/ |
| { |
| int ret; |
| u64 h_ret; |
| u32 hipz_acl; |
| u64 *kpage; |
| u64 rpage; |
| struct ehca_mr_pginfo pginfo_save; |
| struct ehca_mr_hipzout_parms hipzout; |
| |
| ehca_mrmw_map_acl(acl, &hipz_acl); |
| ehca_mrmw_set_pgsize_hipz_acl(pginfo->hwpage_size, &hipz_acl); |
| |
| kpage = ehca_alloc_fw_ctrlblock(GFP_KERNEL); |
| if (!kpage) { |
| ehca_err(&shca->ib_device, "kpage alloc failed"); |
| ret = -ENOMEM; |
| goto ehca_rereg_mr_rereg1_exit0; |
| } |
| |
| pginfo_save = *pginfo; |
| ret = ehca_set_pagebuf(pginfo, pginfo->num_hwpages, kpage); |
| if (ret) { |
| ehca_err(&shca->ib_device, "set pagebuf failed, e_mr=%p " |
| "pginfo=%p type=%x num_kpages=%llx num_hwpages=%llx " |
| "kpage=%p", e_mr, pginfo, pginfo->type, |
| pginfo->num_kpages, pginfo->num_hwpages, kpage); |
| goto ehca_rereg_mr_rereg1_exit1; |
| } |
| rpage = __pa(kpage); |
| if (!rpage) { |
| ehca_err(&shca->ib_device, "kpage=%p", kpage); |
| ret = -EFAULT; |
| goto ehca_rereg_mr_rereg1_exit1; |
| } |
| h_ret = hipz_h_reregister_pmr(shca->ipz_hca_handle, e_mr, |
| (u64)iova_start, size, hipz_acl, |
| e_pd->fw_pd, rpage, &hipzout); |
| if (h_ret != H_SUCCESS) { |
| /* |
| * reregistration unsuccessful, try it again with the 3 hCalls, |
| * e.g. this is required in case H_MR_CONDITION |
| * (MW bound or MR is shared) |
| */ |
| ehca_warn(&shca->ib_device, "hipz_h_reregister_pmr failed " |
| "(Rereg1), h_ret=%lli e_mr=%p", h_ret, e_mr); |
| *pginfo = pginfo_save; |
| ret = -EAGAIN; |
| } else if ((u64 *)hipzout.vaddr != iova_start) { |
| ehca_err(&shca->ib_device, "PHYP changed iova_start in " |
| "rereg_pmr, iova_start=%p iova_start_out=%llx e_mr=%p " |
| "mr_handle=%llx lkey=%x lkey_out=%x", iova_start, |
| hipzout.vaddr, e_mr, e_mr->ipz_mr_handle.handle, |
| e_mr->ib.ib_mr.lkey, hipzout.lkey); |
| ret = -EFAULT; |
| } else { |
| /* |
| * successful reregistration |
| * note: start and start_out are identical for eServer HCAs |
| */ |
| e_mr->num_kpages = pginfo->num_kpages; |
| e_mr->num_hwpages = pginfo->num_hwpages; |
| e_mr->hwpage_size = pginfo->hwpage_size; |
| e_mr->start = iova_start; |
| e_mr->size = size; |
| e_mr->acl = acl; |
| *lkey = hipzout.lkey; |
| *rkey = hipzout.rkey; |
| } |
| |
| ehca_rereg_mr_rereg1_exit1: |
| ehca_free_fw_ctrlblock(kpage); |
| ehca_rereg_mr_rereg1_exit0: |
| if ( ret && (ret != -EAGAIN) ) |
| ehca_err(&shca->ib_device, "ret=%i lkey=%x rkey=%x " |
| "pginfo=%p num_kpages=%llx num_hwpages=%llx", |
| ret, *lkey, *rkey, pginfo, pginfo->num_kpages, |
| pginfo->num_hwpages); |
| return ret; |
| } /* end ehca_rereg_mr_rereg1() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_rereg_mr(struct ehca_shca *shca, |
| struct ehca_mr *e_mr, |
| u64 *iova_start, |
| u64 size, |
| int acl, |
| struct ehca_pd *e_pd, |
| struct ehca_mr_pginfo *pginfo, |
| u32 *lkey, |
| u32 *rkey) |
| { |
| int ret = 0; |
| u64 h_ret; |
| int rereg_1_hcall = 1; /* 1: use hipz_h_reregister_pmr directly */ |
| int rereg_3_hcall = 0; /* 1: use 3 hipz calls for reregistration */ |
| |
| /* first determine reregistration hCall(s) */ |
| if ((pginfo->num_hwpages > MAX_RPAGES) || |
| (e_mr->num_hwpages > MAX_RPAGES) || |
| (pginfo->num_hwpages > e_mr->num_hwpages)) { |
| ehca_dbg(&shca->ib_device, "Rereg3 case, " |
| "pginfo->num_hwpages=%llx e_mr->num_hwpages=%x", |
| pginfo->num_hwpages, e_mr->num_hwpages); |
| rereg_1_hcall = 0; |
| rereg_3_hcall = 1; |
| } |
| |
| if (e_mr->flags & EHCA_MR_FLAG_MAXMR) { /* check for max-MR */ |
| rereg_1_hcall = 0; |
| rereg_3_hcall = 1; |
| e_mr->flags &= ~EHCA_MR_FLAG_MAXMR; |
| ehca_err(&shca->ib_device, "Rereg MR for max-MR! e_mr=%p", |
| e_mr); |
| } |
| |
| if (rereg_1_hcall) { |
| ret = ehca_rereg_mr_rereg1(shca, e_mr, iova_start, size, |
| acl, e_pd, pginfo, lkey, rkey); |
| if (ret) { |
| if (ret == -EAGAIN) |
| rereg_3_hcall = 1; |
| else |
| goto ehca_rereg_mr_exit0; |
| } |
| } |
| |
| if (rereg_3_hcall) { |
| struct ehca_mr save_mr; |
| |
| /* first deregister old MR */ |
| h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_mr); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "hipz_free_mr failed, " |
| "h_ret=%lli e_mr=%p hca_hndl=%llx mr_hndl=%llx " |
| "mr->lkey=%x", |
| h_ret, e_mr, shca->ipz_hca_handle.handle, |
| e_mr->ipz_mr_handle.handle, |
| e_mr->ib.ib_mr.lkey); |
| ret = ehca2ib_return_code(h_ret); |
| goto ehca_rereg_mr_exit0; |
| } |
| /* clean ehca_mr_t, without changing struct ib_mr and lock */ |
| save_mr = *e_mr; |
| ehca_mr_deletenew(e_mr); |
| |
| /* set some MR values */ |
| e_mr->flags = save_mr.flags; |
| e_mr->hwpage_size = save_mr.hwpage_size; |
| e_mr->fmr_page_size = save_mr.fmr_page_size; |
| e_mr->fmr_max_pages = save_mr.fmr_max_pages; |
| e_mr->fmr_max_maps = save_mr.fmr_max_maps; |
| e_mr->fmr_map_cnt = save_mr.fmr_map_cnt; |
| |
| ret = ehca_reg_mr(shca, e_mr, iova_start, size, acl, |
| e_pd, pginfo, lkey, rkey, EHCA_REG_MR); |
| if (ret) { |
| u32 offset = (u64)(&e_mr->flags) - (u64)e_mr; |
| memcpy(&e_mr->flags, &(save_mr.flags), |
| sizeof(struct ehca_mr) - offset); |
| goto ehca_rereg_mr_exit0; |
| } |
| } |
| |
| ehca_rereg_mr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i shca=%p e_mr=%p " |
| "iova_start=%p size=%llx acl=%x e_pd=%p pginfo=%p " |
| "num_kpages=%llx lkey=%x rkey=%x rereg_1_hcall=%x " |
| "rereg_3_hcall=%x", ret, shca, e_mr, iova_start, size, |
| acl, e_pd, pginfo, pginfo->num_kpages, *lkey, *rkey, |
| rereg_1_hcall, rereg_3_hcall); |
| return ret; |
| } /* end ehca_rereg_mr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_unmap_one_fmr(struct ehca_shca *shca, |
| struct ehca_mr *e_fmr) |
| { |
| int ret = 0; |
| u64 h_ret; |
| struct ehca_pd *e_pd = |
| container_of(e_fmr->ib.ib_fmr.pd, struct ehca_pd, ib_pd); |
| struct ehca_mr save_fmr; |
| u32 tmp_lkey, tmp_rkey; |
| struct ehca_mr_pginfo pginfo; |
| struct ehca_mr_hipzout_parms hipzout; |
| struct ehca_mr save_mr; |
| |
| if (e_fmr->fmr_max_pages <= MAX_RPAGES) { |
| /* |
| * note: after using rereg hcall with len=0, |
| * rereg hcall must be used again for registering pages |
| */ |
| h_ret = hipz_h_reregister_pmr(shca->ipz_hca_handle, e_fmr, 0, |
| 0, 0, e_pd->fw_pd, 0, &hipzout); |
| if (h_ret == H_SUCCESS) { |
| /* successful reregistration */ |
| e_fmr->start = NULL; |
| e_fmr->size = 0; |
| tmp_lkey = hipzout.lkey; |
| tmp_rkey = hipzout.rkey; |
| return 0; |
| } |
| /* |
| * should not happen, because length checked above, |
| * FMRs are not shared and no MW bound to FMRs |
| */ |
| ehca_err(&shca->ib_device, "hipz_reregister_pmr failed " |
| "(Rereg1), h_ret=%lli e_fmr=%p hca_hndl=%llx " |
| "mr_hndl=%llx lkey=%x lkey_out=%x", |
| h_ret, e_fmr, shca->ipz_hca_handle.handle, |
| e_fmr->ipz_mr_handle.handle, |
| e_fmr->ib.ib_fmr.lkey, hipzout.lkey); |
| /* try free and rereg */ |
| } |
| |
| /* first free old FMR */ |
| h_ret = hipz_h_free_resource_mr(shca->ipz_hca_handle, e_fmr); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "hipz_free_mr failed, " |
| "h_ret=%lli e_fmr=%p hca_hndl=%llx mr_hndl=%llx " |
| "lkey=%x", |
| h_ret, e_fmr, shca->ipz_hca_handle.handle, |
| e_fmr->ipz_mr_handle.handle, |
| e_fmr->ib.ib_fmr.lkey); |
| ret = ehca2ib_return_code(h_ret); |
| goto ehca_unmap_one_fmr_exit0; |
| } |
| /* clean ehca_mr_t, without changing lock */ |
| save_fmr = *e_fmr; |
| ehca_mr_deletenew(e_fmr); |
| |
| /* set some MR values */ |
| e_fmr->flags = save_fmr.flags; |
| e_fmr->hwpage_size = save_fmr.hwpage_size; |
| e_fmr->fmr_page_size = save_fmr.fmr_page_size; |
| e_fmr->fmr_max_pages = save_fmr.fmr_max_pages; |
| e_fmr->fmr_max_maps = save_fmr.fmr_max_maps; |
| e_fmr->fmr_map_cnt = save_fmr.fmr_map_cnt; |
| e_fmr->acl = save_fmr.acl; |
| |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.type = EHCA_MR_PGI_FMR; |
| ret = ehca_reg_mr(shca, e_fmr, NULL, |
| (e_fmr->fmr_max_pages * e_fmr->fmr_page_size), |
| e_fmr->acl, e_pd, &pginfo, &tmp_lkey, |
| &tmp_rkey, EHCA_REG_MR); |
| if (ret) { |
| u32 offset = (u64)(&e_fmr->flags) - (u64)e_fmr; |
| memcpy(&e_fmr->flags, &(save_mr.flags), |
| sizeof(struct ehca_mr) - offset); |
| } |
| |
| ehca_unmap_one_fmr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i tmp_lkey=%x tmp_rkey=%x " |
| "fmr_max_pages=%x", |
| ret, tmp_lkey, tmp_rkey, e_fmr->fmr_max_pages); |
| return ret; |
| } /* end ehca_unmap_one_fmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_reg_smr(struct ehca_shca *shca, |
| struct ehca_mr *e_origmr, |
| struct ehca_mr *e_newmr, |
| u64 *iova_start, |
| int acl, |
| struct ehca_pd *e_pd, |
| u32 *lkey, /*OUT*/ |
| u32 *rkey) /*OUT*/ |
| { |
| int ret = 0; |
| u64 h_ret; |
| u32 hipz_acl; |
| struct ehca_mr_hipzout_parms hipzout; |
| |
| ehca_mrmw_map_acl(acl, &hipz_acl); |
| ehca_mrmw_set_pgsize_hipz_acl(e_origmr->hwpage_size, &hipz_acl); |
| |
| h_ret = hipz_h_register_smr(shca->ipz_hca_handle, e_newmr, e_origmr, |
| (u64)iova_start, hipz_acl, e_pd->fw_pd, |
| &hipzout); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "hipz_reg_smr failed, h_ret=%lli " |
| "shca=%p e_origmr=%p e_newmr=%p iova_start=%p acl=%x " |
| "e_pd=%p hca_hndl=%llx mr_hndl=%llx lkey=%x", |
| h_ret, shca, e_origmr, e_newmr, iova_start, acl, e_pd, |
| shca->ipz_hca_handle.handle, |
| e_origmr->ipz_mr_handle.handle, |
| e_origmr->ib.ib_mr.lkey); |
| ret = ehca2ib_return_code(h_ret); |
| goto ehca_reg_smr_exit0; |
| } |
| /* successful registration */ |
| e_newmr->num_kpages = e_origmr->num_kpages; |
| e_newmr->num_hwpages = e_origmr->num_hwpages; |
| e_newmr->hwpage_size = e_origmr->hwpage_size; |
| e_newmr->start = iova_start; |
| e_newmr->size = e_origmr->size; |
| e_newmr->acl = acl; |
| e_newmr->ipz_mr_handle = hipzout.handle; |
| *lkey = hipzout.lkey; |
| *rkey = hipzout.rkey; |
| return 0; |
| |
| ehca_reg_smr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i shca=%p e_origmr=%p " |
| "e_newmr=%p iova_start=%p acl=%x e_pd=%p", |
| ret, shca, e_origmr, e_newmr, iova_start, acl, e_pd); |
| return ret; |
| } /* end ehca_reg_smr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| static inline void *ehca_calc_sectbase(int top, int dir, int idx) |
| { |
| unsigned long ret = idx; |
| ret |= dir << EHCA_DIR_INDEX_SHIFT; |
| ret |= top << EHCA_TOP_INDEX_SHIFT; |
| return __va(ret << SECTION_SIZE_BITS); |
| } |
| |
| #define ehca_bmap_valid(entry) \ |
| ((u64)entry != (u64)EHCA_INVAL_ADDR) |
| |
| static u64 ehca_reg_mr_section(int top, int dir, int idx, u64 *kpage, |
| struct ehca_shca *shca, struct ehca_mr *mr, |
| struct ehca_mr_pginfo *pginfo) |
| { |
| u64 h_ret = 0; |
| unsigned long page = 0; |
| u64 rpage = __pa(kpage); |
| int page_count; |
| |
| void *sectbase = ehca_calc_sectbase(top, dir, idx); |
| if ((unsigned long)sectbase & (pginfo->hwpage_size - 1)) { |
| ehca_err(&shca->ib_device, "reg_mr_section will probably fail:" |
| "hwpage_size does not fit to " |
| "section start address"); |
| } |
| page_count = EHCA_SECTSIZE / pginfo->hwpage_size; |
| |
| while (page < page_count) { |
| u64 rnum; |
| for (rnum = 0; (rnum < MAX_RPAGES) && (page < page_count); |
| rnum++) { |
| void *pg = sectbase + ((page++) * pginfo->hwpage_size); |
| kpage[rnum] = __pa(pg); |
| } |
| |
| h_ret = hipz_h_register_rpage_mr(shca->ipz_hca_handle, mr, |
| ehca_encode_hwpage_size(pginfo->hwpage_size), |
| 0, rpage, rnum); |
| |
| if ((h_ret != H_SUCCESS) && (h_ret != H_PAGE_REGISTERED)) { |
| ehca_err(&shca->ib_device, "register_rpage_mr failed"); |
| return h_ret; |
| } |
| } |
| return h_ret; |
| } |
| |
| static u64 ehca_reg_mr_sections(int top, int dir, u64 *kpage, |
| struct ehca_shca *shca, struct ehca_mr *mr, |
| struct ehca_mr_pginfo *pginfo) |
| { |
| u64 hret = H_SUCCESS; |
| int idx; |
| |
| for (idx = 0; idx < EHCA_MAP_ENTRIES; idx++) { |
| if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir]->ent[idx])) |
| continue; |
| |
| hret = ehca_reg_mr_section(top, dir, idx, kpage, shca, mr, |
| pginfo); |
| if ((hret != H_SUCCESS) && (hret != H_PAGE_REGISTERED)) |
| return hret; |
| } |
| return hret; |
| } |
| |
| static u64 ehca_reg_mr_dir_sections(int top, u64 *kpage, struct ehca_shca *shca, |
| struct ehca_mr *mr, |
| struct ehca_mr_pginfo *pginfo) |
| { |
| u64 hret = H_SUCCESS; |
| int dir; |
| |
| for (dir = 0; dir < EHCA_MAP_ENTRIES; dir++) { |
| if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir])) |
| continue; |
| |
| hret = ehca_reg_mr_sections(top, dir, kpage, shca, mr, pginfo); |
| if ((hret != H_SUCCESS) && (hret != H_PAGE_REGISTERED)) |
| return hret; |
| } |
| return hret; |
| } |
| |
| /* register internal max-MR to internal SHCA */ |
| int ehca_reg_internal_maxmr( |
| struct ehca_shca *shca, |
| struct ehca_pd *e_pd, |
| struct ehca_mr **e_maxmr) /*OUT*/ |
| { |
| int ret; |
| struct ehca_mr *e_mr; |
| u64 *iova_start; |
| u64 size_maxmr; |
| struct ehca_mr_pginfo pginfo; |
| struct ib_phys_buf ib_pbuf; |
| u32 num_kpages; |
| u32 num_hwpages; |
| u64 hw_pgsize; |
| |
| if (!ehca_bmap) { |
| ret = -EFAULT; |
| goto ehca_reg_internal_maxmr_exit0; |
| } |
| |
| e_mr = ehca_mr_new(); |
| if (!e_mr) { |
| ehca_err(&shca->ib_device, "out of memory"); |
| ret = -ENOMEM; |
| goto ehca_reg_internal_maxmr_exit0; |
| } |
| e_mr->flags |= EHCA_MR_FLAG_MAXMR; |
| |
| /* register internal max-MR on HCA */ |
| size_maxmr = ehca_mr_len; |
| iova_start = (u64 *)ehca_map_vaddr((void *)(KERNELBASE + PHYSICAL_START)); |
| ib_pbuf.addr = 0; |
| ib_pbuf.size = size_maxmr; |
| num_kpages = NUM_CHUNKS(((u64)iova_start % PAGE_SIZE) + size_maxmr, |
| PAGE_SIZE); |
| hw_pgsize = ehca_get_max_hwpage_size(shca); |
| num_hwpages = NUM_CHUNKS(((u64)iova_start % hw_pgsize) + size_maxmr, |
| hw_pgsize); |
| |
| memset(&pginfo, 0, sizeof(pginfo)); |
| pginfo.type = EHCA_MR_PGI_PHYS; |
| pginfo.num_kpages = num_kpages; |
| pginfo.num_hwpages = num_hwpages; |
| pginfo.hwpage_size = hw_pgsize; |
| pginfo.u.phy.num_phys_buf = 1; |
| pginfo.u.phy.phys_buf_array = &ib_pbuf; |
| |
| ret = ehca_reg_mr(shca, e_mr, iova_start, size_maxmr, 0, e_pd, |
| &pginfo, &e_mr->ib.ib_mr.lkey, |
| &e_mr->ib.ib_mr.rkey, EHCA_REG_BUSMAP_MR); |
| if (ret) { |
| ehca_err(&shca->ib_device, "reg of internal max MR failed, " |
| "e_mr=%p iova_start=%p size_maxmr=%llx num_kpages=%x " |
| "num_hwpages=%x", e_mr, iova_start, size_maxmr, |
| num_kpages, num_hwpages); |
| goto ehca_reg_internal_maxmr_exit1; |
| } |
| |
| /* successful registration of all pages */ |
| e_mr->ib.ib_mr.device = e_pd->ib_pd.device; |
| e_mr->ib.ib_mr.pd = &e_pd->ib_pd; |
| e_mr->ib.ib_mr.uobject = NULL; |
| atomic_inc(&(e_pd->ib_pd.usecnt)); |
| atomic_set(&(e_mr->ib.ib_mr.usecnt), 0); |
| *e_maxmr = e_mr; |
| return 0; |
| |
| ehca_reg_internal_maxmr_exit1: |
| ehca_mr_delete(e_mr); |
| ehca_reg_internal_maxmr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i shca=%p e_pd=%p e_maxmr=%p", |
| ret, shca, e_pd, e_maxmr); |
| return ret; |
| } /* end ehca_reg_internal_maxmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_reg_maxmr(struct ehca_shca *shca, |
| struct ehca_mr *e_newmr, |
| u64 *iova_start, |
| int acl, |
| struct ehca_pd *e_pd, |
| u32 *lkey, |
| u32 *rkey) |
| { |
| u64 h_ret; |
| struct ehca_mr *e_origmr = shca->maxmr; |
| u32 hipz_acl; |
| struct ehca_mr_hipzout_parms hipzout; |
| |
| ehca_mrmw_map_acl(acl, &hipz_acl); |
| ehca_mrmw_set_pgsize_hipz_acl(e_origmr->hwpage_size, &hipz_acl); |
| |
| h_ret = hipz_h_register_smr(shca->ipz_hca_handle, e_newmr, e_origmr, |
| (u64)iova_start, hipz_acl, e_pd->fw_pd, |
| &hipzout); |
| if (h_ret != H_SUCCESS) { |
| ehca_err(&shca->ib_device, "hipz_reg_smr failed, h_ret=%lli " |
| "e_origmr=%p hca_hndl=%llx mr_hndl=%llx lkey=%x", |
| h_ret, e_origmr, shca->ipz_hca_handle.handle, |
| e_origmr->ipz_mr_handle.handle, |
| e_origmr->ib.ib_mr.lkey); |
| return ehca2ib_return_code(h_ret); |
| } |
| /* successful registration */ |
| e_newmr->num_kpages = e_origmr->num_kpages; |
| e_newmr->num_hwpages = e_origmr->num_hwpages; |
| e_newmr->hwpage_size = e_origmr->hwpage_size; |
| e_newmr->start = iova_start; |
| e_newmr->size = e_origmr->size; |
| e_newmr->acl = acl; |
| e_newmr->ipz_mr_handle = hipzout.handle; |
| *lkey = hipzout.lkey; |
| *rkey = hipzout.rkey; |
| return 0; |
| } /* end ehca_reg_maxmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| int ehca_dereg_internal_maxmr(struct ehca_shca *shca) |
| { |
| int ret; |
| struct ehca_mr *e_maxmr; |
| struct ib_pd *ib_pd; |
| |
| if (!shca->maxmr) { |
| ehca_err(&shca->ib_device, "bad call, shca=%p", shca); |
| ret = -EINVAL; |
| goto ehca_dereg_internal_maxmr_exit0; |
| } |
| |
| e_maxmr = shca->maxmr; |
| ib_pd = e_maxmr->ib.ib_mr.pd; |
| shca->maxmr = NULL; /* remove internal max-MR indication from SHCA */ |
| |
| ret = ehca_dereg_mr(&e_maxmr->ib.ib_mr); |
| if (ret) { |
| ehca_err(&shca->ib_device, "dereg internal max-MR failed, " |
| "ret=%i e_maxmr=%p shca=%p lkey=%x", |
| ret, e_maxmr, shca, e_maxmr->ib.ib_mr.lkey); |
| shca->maxmr = e_maxmr; |
| goto ehca_dereg_internal_maxmr_exit0; |
| } |
| |
| atomic_dec(&ib_pd->usecnt); |
| |
| ehca_dereg_internal_maxmr_exit0: |
| if (ret) |
| ehca_err(&shca->ib_device, "ret=%i shca=%p shca->maxmr=%p", |
| ret, shca, shca->maxmr); |
| return ret; |
| } /* end ehca_dereg_internal_maxmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* |
| * check physical buffer array of MR verbs for validness and |
| * calculates MR size |
| */ |
| int ehca_mr_chk_buf_and_calc_size(struct ib_phys_buf *phys_buf_array, |
| int num_phys_buf, |
| u64 *iova_start, |
| u64 *size) |
| { |
| struct ib_phys_buf *pbuf = phys_buf_array; |
| u64 size_count = 0; |
| u32 i; |
| |
| if (num_phys_buf == 0) { |
| ehca_gen_err("bad phys buf array len, num_phys_buf=0"); |
| return -EINVAL; |
| } |
| /* check first buffer */ |
| if (((u64)iova_start & ~PAGE_MASK) != (pbuf->addr & ~PAGE_MASK)) { |
| ehca_gen_err("iova_start/addr mismatch, iova_start=%p " |
| "pbuf->addr=%llx pbuf->size=%llx", |
| iova_start, pbuf->addr, pbuf->size); |
| return -EINVAL; |
| } |
| if (((pbuf->addr + pbuf->size) % PAGE_SIZE) && |
| (num_phys_buf > 1)) { |
| ehca_gen_err("addr/size mismatch in 1st buf, pbuf->addr=%llx " |
| "pbuf->size=%llx", pbuf->addr, pbuf->size); |
| return -EINVAL; |
| } |
| |
| for (i = 0; i < num_phys_buf; i++) { |
| if ((i > 0) && (pbuf->addr % PAGE_SIZE)) { |
| ehca_gen_err("bad address, i=%x pbuf->addr=%llx " |
| "pbuf->size=%llx", |
| i, pbuf->addr, pbuf->size); |
| return -EINVAL; |
| } |
| if (((i > 0) && /* not 1st */ |
| (i < (num_phys_buf - 1)) && /* not last */ |
| (pbuf->size % PAGE_SIZE)) || (pbuf->size == 0)) { |
| ehca_gen_err("bad size, i=%x pbuf->size=%llx", |
| i, pbuf->size); |
| return -EINVAL; |
| } |
| size_count += pbuf->size; |
| pbuf++; |
| } |
| |
| *size = size_count; |
| return 0; |
| } /* end ehca_mr_chk_buf_and_calc_size() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* check page list of map FMR verb for validness */ |
| int ehca_fmr_check_page_list(struct ehca_mr *e_fmr, |
| u64 *page_list, |
| int list_len) |
| { |
| u32 i; |
| u64 *page; |
| |
| if ((list_len == 0) || (list_len > e_fmr->fmr_max_pages)) { |
| ehca_gen_err("bad list_len, list_len=%x " |
| "e_fmr->fmr_max_pages=%x fmr=%p", |
| list_len, e_fmr->fmr_max_pages, e_fmr); |
| return -EINVAL; |
| } |
| |
| /* each page must be aligned */ |
| page = page_list; |
| for (i = 0; i < list_len; i++) { |
| if (*page % e_fmr->fmr_page_size) { |
| ehca_gen_err("bad page, i=%x *page=%llx page=%p fmr=%p " |
| "fmr_page_size=%x", i, *page, page, e_fmr, |
| e_fmr->fmr_page_size); |
| return -EINVAL; |
| } |
| page++; |
| } |
| |
| return 0; |
| } /* end ehca_fmr_check_page_list() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* PAGE_SIZE >= pginfo->hwpage_size */ |
| static int ehca_set_pagebuf_user1(struct ehca_mr_pginfo *pginfo, |
| u32 number, |
| u64 *kpage) |
| { |
| int ret = 0; |
| u64 pgaddr; |
| u32 j = 0; |
| int hwpages_per_kpage = PAGE_SIZE / pginfo->hwpage_size; |
| struct scatterlist **sg = &pginfo->u.usr.next_sg; |
| |
| while (*sg != NULL) { |
| pgaddr = page_to_pfn(sg_page(*sg)) |
| << PAGE_SHIFT; |
| *kpage = pgaddr + (pginfo->next_hwpage * |
| pginfo->hwpage_size); |
| if (!(*kpage)) { |
| ehca_gen_err("pgaddr=%llx " |
| "sg_dma_address=%llx " |
| "entry=%llx next_hwpage=%llx", |
| pgaddr, (u64)sg_dma_address(*sg), |
| pginfo->u.usr.next_nmap, |
| pginfo->next_hwpage); |
| return -EFAULT; |
| } |
| (pginfo->hwpage_cnt)++; |
| (pginfo->next_hwpage)++; |
| kpage++; |
| if (pginfo->next_hwpage % hwpages_per_kpage == 0) { |
| (pginfo->kpage_cnt)++; |
| (pginfo->u.usr.next_nmap)++; |
| pginfo->next_hwpage = 0; |
| *sg = sg_next(*sg); |
| } |
| j++; |
| if (j >= number) |
| break; |
| } |
| |
| return ret; |
| } |
| |
| /* |
| * check given pages for contiguous layout |
| * last page addr is returned in prev_pgaddr for further check |
| */ |
| static int ehca_check_kpages_per_ate(struct scatterlist **sg, |
| int num_pages, |
| u64 *prev_pgaddr) |
| { |
| for (; *sg && num_pages > 0; *sg = sg_next(*sg), num_pages--) { |
| u64 pgaddr = page_to_pfn(sg_page(*sg)) << PAGE_SHIFT; |
| if (ehca_debug_level >= 3) |
| ehca_gen_dbg("chunk_page=%llx value=%016llx", pgaddr, |
| *(u64 *)__va(pgaddr)); |
| if (pgaddr - PAGE_SIZE != *prev_pgaddr) { |
| ehca_gen_err("uncontiguous page found pgaddr=%llx " |
| "prev_pgaddr=%llx entries_left_in_hwpage=%x", |
| pgaddr, *prev_pgaddr, num_pages); |
| return -EINVAL; |
| } |
| *prev_pgaddr = pgaddr; |
| } |
| return 0; |
| } |
| |
| /* PAGE_SIZE < pginfo->hwpage_size */ |
| static int ehca_set_pagebuf_user2(struct ehca_mr_pginfo *pginfo, |
| u32 number, |
| u64 *kpage) |
| { |
| int ret = 0; |
| u64 pgaddr, prev_pgaddr; |
| u32 j = 0; |
| int kpages_per_hwpage = pginfo->hwpage_size / PAGE_SIZE; |
| int nr_kpages = kpages_per_hwpage; |
| struct scatterlist **sg = &pginfo->u.usr.next_sg; |
| |
| while (*sg != NULL) { |
| |
| if (nr_kpages == kpages_per_hwpage) { |
| pgaddr = (page_to_pfn(sg_page(*sg)) |
| << PAGE_SHIFT); |
| *kpage = pgaddr; |
| if (!(*kpage)) { |
| ehca_gen_err("pgaddr=%llx entry=%llx", |
| pgaddr, pginfo->u.usr.next_nmap); |
| ret = -EFAULT; |
| return ret; |
| } |
| /* |
| * The first page in a hwpage must be aligned; |
| * the first MR page is exempt from this rule. |
| */ |
| if (pgaddr & (pginfo->hwpage_size - 1)) { |
| if (pginfo->hwpage_cnt) { |
| ehca_gen_err( |
| "invalid alignment " |
| "pgaddr=%llx entry=%llx " |
| "mr_pgsize=%llx", |
| pgaddr, pginfo->u.usr.next_nmap, |
| pginfo->hwpage_size); |
| ret = -EFAULT; |
| return ret; |
| } |
| /* first MR page */ |
| pginfo->kpage_cnt = |
| (pgaddr & |
| (pginfo->hwpage_size - 1)) >> |
| PAGE_SHIFT; |
| nr_kpages -= pginfo->kpage_cnt; |
| *kpage = pgaddr & |
| ~(pginfo->hwpage_size - 1); |
| } |
| if (ehca_debug_level >= 3) { |
| u64 val = *(u64 *)__va(pgaddr); |
| ehca_gen_dbg("kpage=%llx page=%llx " |
| "value=%016llx", |
| *kpage, pgaddr, val); |
| } |
| prev_pgaddr = pgaddr; |
| *sg = sg_next(*sg); |
| pginfo->kpage_cnt++; |
| pginfo->u.usr.next_nmap++; |
| nr_kpages--; |
| if (!nr_kpages) |
| goto next_kpage; |
| continue; |
| } |
| |
| ret = ehca_check_kpages_per_ate(sg, nr_kpages, |
| &prev_pgaddr); |
| if (ret) |
| return ret; |
| pginfo->kpage_cnt += nr_kpages; |
| pginfo->u.usr.next_nmap += nr_kpages; |
| |
| next_kpage: |
| nr_kpages = kpages_per_hwpage; |
| (pginfo->hwpage_cnt)++; |
| kpage++; |
| j++; |
| if (j >= number) |
| break; |
| } |
| |
| return ret; |
| } |
| |
| static int ehca_set_pagebuf_phys(struct ehca_mr_pginfo *pginfo, |
| u32 number, u64 *kpage) |
| { |
| int ret = 0; |
| struct ib_phys_buf *pbuf; |
| u64 num_hw, offs_hw; |
| u32 i = 0; |
| |
| /* loop over desired phys_buf_array entries */ |
| while (i < number) { |
| pbuf = pginfo->u.phy.phys_buf_array + pginfo->u.phy.next_buf; |
| num_hw = NUM_CHUNKS((pbuf->addr % pginfo->hwpage_size) + |
| pbuf->size, pginfo->hwpage_size); |
| offs_hw = (pbuf->addr & ~(pginfo->hwpage_size - 1)) / |
| pginfo->hwpage_size; |
| while (pginfo->next_hwpage < offs_hw + num_hw) { |
| /* sanity check */ |
| if ((pginfo->kpage_cnt >= pginfo->num_kpages) || |
| (pginfo->hwpage_cnt >= pginfo->num_hwpages)) { |
| ehca_gen_err("kpage_cnt >= num_kpages, " |
| "kpage_cnt=%llx num_kpages=%llx " |
| "hwpage_cnt=%llx " |
| "num_hwpages=%llx i=%x", |
| pginfo->kpage_cnt, |
| pginfo->num_kpages, |
| pginfo->hwpage_cnt, |
| pginfo->num_hwpages, i); |
| return -EFAULT; |
| } |
| *kpage = (pbuf->addr & ~(pginfo->hwpage_size - 1)) + |
| (pginfo->next_hwpage * pginfo->hwpage_size); |
| if ( !(*kpage) && pbuf->addr ) { |
| ehca_gen_err("pbuf->addr=%llx pbuf->size=%llx " |
| "next_hwpage=%llx", pbuf->addr, |
| pbuf->size, pginfo->next_hwpage); |
| return -EFAULT; |
| } |
| (pginfo->hwpage_cnt)++; |
| (pginfo->next_hwpage)++; |
| if (PAGE_SIZE >= pginfo->hwpage_size) { |
| if (pginfo->next_hwpage % |
| (PAGE_SIZE / pginfo->hwpage_size) == 0) |
| (pginfo->kpage_cnt)++; |
| } else |
| pginfo->kpage_cnt += pginfo->hwpage_size / |
| PAGE_SIZE; |
| kpage++; |
| i++; |
| if (i >= number) break; |
| } |
| if (pginfo->next_hwpage >= offs_hw + num_hw) { |
| (pginfo->u.phy.next_buf)++; |
| pginfo->next_hwpage = 0; |
| } |
| } |
| return ret; |
| } |
| |
| static int ehca_set_pagebuf_fmr(struct ehca_mr_pginfo *pginfo, |
| u32 number, u64 *kpage) |
| { |
| int ret = 0; |
| u64 *fmrlist; |
| u32 i; |
| |
| /* loop over desired page_list entries */ |
| fmrlist = pginfo->u.fmr.page_list + pginfo->u.fmr.next_listelem; |
| for (i = 0; i < number; i++) { |
| *kpage = (*fmrlist & ~(pginfo->hwpage_size - 1)) + |
| pginfo->next_hwpage * pginfo->hwpage_size; |
| if ( !(*kpage) ) { |
| ehca_gen_err("*fmrlist=%llx fmrlist=%p " |
| "next_listelem=%llx next_hwpage=%llx", |
| *fmrlist, fmrlist, |
| pginfo->u.fmr.next_listelem, |
| pginfo->next_hwpage); |
| return -EFAULT; |
| } |
| (pginfo->hwpage_cnt)++; |
| if (pginfo->u.fmr.fmr_pgsize >= pginfo->hwpage_size) { |
| if (pginfo->next_hwpage % |
| (pginfo->u.fmr.fmr_pgsize / |
| pginfo->hwpage_size) == 0) { |
| (pginfo->kpage_cnt)++; |
| (pginfo->u.fmr.next_listelem)++; |
| fmrlist++; |
| pginfo->next_hwpage = 0; |
| } else |
| (pginfo->next_hwpage)++; |
| } else { |
| unsigned int cnt_per_hwpage = pginfo->hwpage_size / |
| pginfo->u.fmr.fmr_pgsize; |
| unsigned int j; |
| u64 prev = *kpage; |
| /* check if adrs are contiguous */ |
| for (j = 1; j < cnt_per_hwpage; j++) { |
| u64 p = fmrlist[j] & ~(pginfo->hwpage_size - 1); |
| if (prev + pginfo->u.fmr.fmr_pgsize != p) { |
| ehca_gen_err("uncontiguous fmr pages " |
| "found prev=%llx p=%llx " |
| "idx=%x", prev, p, i + j); |
| return -EINVAL; |
| } |
| prev = p; |
| } |
| pginfo->kpage_cnt += cnt_per_hwpage; |
| pginfo->u.fmr.next_listelem += cnt_per_hwpage; |
| fmrlist += cnt_per_hwpage; |
| } |
| kpage++; |
| } |
| return ret; |
| } |
| |
| /* setup page buffer from page info */ |
| int ehca_set_pagebuf(struct ehca_mr_pginfo *pginfo, |
| u32 number, |
| u64 *kpage) |
| { |
| int ret; |
| |
| switch (pginfo->type) { |
| case EHCA_MR_PGI_PHYS: |
| ret = ehca_set_pagebuf_phys(pginfo, number, kpage); |
| break; |
| case EHCA_MR_PGI_USER: |
| ret = PAGE_SIZE >= pginfo->hwpage_size ? |
| ehca_set_pagebuf_user1(pginfo, number, kpage) : |
| ehca_set_pagebuf_user2(pginfo, number, kpage); |
| break; |
| case EHCA_MR_PGI_FMR: |
| ret = ehca_set_pagebuf_fmr(pginfo, number, kpage); |
| break; |
| default: |
| ehca_gen_err("bad pginfo->type=%x", pginfo->type); |
| ret = -EFAULT; |
| break; |
| } |
| return ret; |
| } /* end ehca_set_pagebuf() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* |
| * check MR if it is a max-MR, i.e. uses whole memory |
| * in case it's a max-MR 1 is returned, else 0 |
| */ |
| int ehca_mr_is_maxmr(u64 size, |
| u64 *iova_start) |
| { |
| /* a MR is treated as max-MR only if it fits following: */ |
| if ((size == ehca_mr_len) && |
| (iova_start == (void *)ehca_map_vaddr((void *)(KERNELBASE + PHYSICAL_START)))) { |
| ehca_gen_dbg("this is a max-MR"); |
| return 1; |
| } else |
| return 0; |
| } /* end ehca_mr_is_maxmr() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* map access control for MR/MW. This routine is used for MR and MW. */ |
| void ehca_mrmw_map_acl(int ib_acl, |
| u32 *hipz_acl) |
| { |
| *hipz_acl = 0; |
| if (ib_acl & IB_ACCESS_REMOTE_READ) |
| *hipz_acl |= HIPZ_ACCESSCTRL_R_READ; |
| if (ib_acl & IB_ACCESS_REMOTE_WRITE) |
| *hipz_acl |= HIPZ_ACCESSCTRL_R_WRITE; |
| if (ib_acl & IB_ACCESS_REMOTE_ATOMIC) |
| *hipz_acl |= HIPZ_ACCESSCTRL_R_ATOMIC; |
| if (ib_acl & IB_ACCESS_LOCAL_WRITE) |
| *hipz_acl |= HIPZ_ACCESSCTRL_L_WRITE; |
| if (ib_acl & IB_ACCESS_MW_BIND) |
| *hipz_acl |= HIPZ_ACCESSCTRL_MW_BIND; |
| } /* end ehca_mrmw_map_acl() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* sets page size in hipz access control for MR/MW. */ |
| void ehca_mrmw_set_pgsize_hipz_acl(u32 pgsize, u32 *hipz_acl) /*INOUT*/ |
| { |
| *hipz_acl |= (ehca_encode_hwpage_size(pgsize) << 24); |
| } /* end ehca_mrmw_set_pgsize_hipz_acl() */ |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* |
| * reverse map access control for MR/MW. |
| * This routine is used for MR and MW. |
| */ |
| void ehca_mrmw_reverse_map_acl(const u32 *hipz_acl, |
| int *ib_acl) /*OUT*/ |
| { |
| *ib_acl = 0; |
| if (*hipz_acl & HIPZ_ACCESSCTRL_R_READ) |
| *ib_acl |= IB_ACCESS_REMOTE_READ; |
| if (*hipz_acl & HIPZ_ACCESSCTRL_R_WRITE) |
| *ib_acl |= IB_ACCESS_REMOTE_WRITE; |
| if (*hipz_acl & HIPZ_ACCESSCTRL_R_ATOMIC) |
| *ib_acl |= IB_ACCESS_REMOTE_ATOMIC; |
| if (*hipz_acl & HIPZ_ACCESSCTRL_L_WRITE) |
| *ib_acl |= IB_ACCESS_LOCAL_WRITE; |
| if (*hipz_acl & HIPZ_ACCESSCTRL_MW_BIND) |
| *ib_acl |= IB_ACCESS_MW_BIND; |
| } /* end ehca_mrmw_reverse_map_acl() */ |
| |
| |
| /*----------------------------------------------------------------------*/ |
| |
| /* |
| * MR destructor and constructor |
| * used in Reregister MR verb, sets all fields in ehca_mr_t to 0, |
| * except struct ib_mr and spinlock |
| */ |
| void ehca_mr_deletenew(struct ehca_mr *mr) |
| { |
| mr->flags = 0; |
| mr->num_kpages = 0; |
| mr->num_hwpages = 0; |
| mr->acl = 0; |
| mr->start = NULL; |
| mr->fmr_page_size = 0; |
| mr->fmr_max_pages = 0; |
| mr->fmr_max_maps = 0; |
| mr->fmr_map_cnt = 0; |
| memset(&mr->ipz_mr_handle, 0, sizeof(mr->ipz_mr_handle)); |
| memset(&mr->galpas, 0, sizeof(mr->galpas)); |
| } /* end ehca_mr_deletenew() */ |
| |
| int ehca_init_mrmw_cache(void) |
| { |
| mr_cache = kmem_cache_create("ehca_cache_mr", |
| sizeof(struct ehca_mr), 0, |
| SLAB_HWCACHE_ALIGN, |
| NULL); |
| if (!mr_cache) |
| return -ENOMEM; |
| mw_cache = kmem_cache_create("ehca_cache_mw", |
| sizeof(struct ehca_mw), 0, |
| SLAB_HWCACHE_ALIGN, |
| NULL); |
| if (!mw_cache) { |
| kmem_cache_destroy(mr_cache); |
| mr_cache = NULL; |
| return -ENOMEM; |
| } |
| return 0; |
| } |
| |
| void ehca_cleanup_mrmw_cache(void) |
| { |
| if (mr_cache) |
| kmem_cache_destroy(mr_cache); |
| if (mw_cache) |
| kmem_cache_destroy(mw_cache); |
| } |
| |
| static inline int ehca_init_top_bmap(struct ehca_top_bmap *ehca_top_bmap, |
| int dir) |
| { |
| if (!ehca_bmap_valid(ehca_top_bmap->dir[dir])) { |
| ehca_top_bmap->dir[dir] = |
| kmalloc(sizeof(struct ehca_dir_bmap), GFP_KERNEL); |
| if (!ehca_top_bmap->dir[dir]) |
| return -ENOMEM; |
| /* Set map block to 0xFF according to EHCA_INVAL_ADDR */ |
| memset(ehca_top_bmap->dir[dir], 0xFF, EHCA_ENT_MAP_SIZE); |
| } |
| return 0; |
| } |
| |
| static inline int ehca_init_bmap(struct ehca_bmap *ehca_bmap, int top, int dir) |
| { |
| if (!ehca_bmap_valid(ehca_bmap->top[top])) { |
| ehca_bmap->top[top] = |
| kmalloc(sizeof(struct ehca_top_bmap), GFP_KERNEL); |
| if (!ehca_bmap->top[top]) |
| return -ENOMEM; |
| /* Set map block to 0xFF according to EHCA_INVAL_ADDR */ |
| memset(ehca_bmap->top[top], 0xFF, EHCA_DIR_MAP_SIZE); |
| } |
| return ehca_init_top_bmap(ehca_bmap->top[top], dir); |
| } |
| |
| static inline int ehca_calc_index(unsigned long i, unsigned long s) |
| { |
| return (i >> s) & EHCA_INDEX_MASK; |
| } |
| |
| void ehca_destroy_busmap(void) |
| { |
| int top, dir; |
| |
| if (!ehca_bmap) |
| return; |
| |
| for (top = 0; top < EHCA_MAP_ENTRIES; top++) { |
| if (!ehca_bmap_valid(ehca_bmap->top[top])) |
| continue; |
| for (dir = 0; dir < EHCA_MAP_ENTRIES; dir++) { |
| if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir])) |
| continue; |
| |
| kfree(ehca_bmap->top[top]->dir[dir]); |
| } |
| |
| kfree(ehca_bmap->top[top]); |
| } |
| |
| kfree(ehca_bmap); |
| ehca_bmap = NULL; |
| } |
| |
| static int ehca_update_busmap(unsigned long pfn, unsigned long nr_pages) |
| { |
| unsigned long i, start_section, end_section; |
| int top, dir, idx; |
| |
| if (!nr_pages) |
| return 0; |
| |
| if (!ehca_bmap) { |
| ehca_bmap = kmalloc(sizeof(struct ehca_bmap), GFP_KERNEL); |
| if (!ehca_bmap) |
| return -ENOMEM; |
| /* Set map block to 0xFF according to EHCA_INVAL_ADDR */ |
| memset(ehca_bmap, 0xFF, EHCA_TOP_MAP_SIZE); |
| } |
| |
| start_section = (pfn * PAGE_SIZE) / EHCA_SECTSIZE; |
| end_section = ((pfn + nr_pages) * PAGE_SIZE) / EHCA_SECTSIZE; |
| for (i = start_section; i < end_section; i++) { |
| int ret; |
| top = ehca_calc_index(i, EHCA_TOP_INDEX_SHIFT); |
| dir = ehca_calc_index(i, EHCA_DIR_INDEX_SHIFT); |
| idx = i & EHCA_INDEX_MASK; |
| |
| ret = ehca_init_bmap(ehca_bmap, top, dir); |
| if (ret) { |
| ehca_destroy_busmap(); |
| return ret; |
| } |
| ehca_bmap->top[top]->dir[dir]->ent[idx] = ehca_mr_len; |
| ehca_mr_len += EHCA_SECTSIZE; |
| } |
| return 0; |
| } |
| |
| static int ehca_is_hugepage(unsigned long pfn) |
| { |
| int page_order; |
| |
| if (pfn & EHCA_HUGEPAGE_PFN_MASK) |
| return 0; |
| |
| page_order = compound_order(pfn_to_page(pfn)); |
| if (page_order + PAGE_SHIFT != EHCA_HUGEPAGESHIFT) |
| return 0; |
| |
| return 1; |
| } |
| |
| static int ehca_create_busmap_callback(unsigned long initial_pfn, |
| unsigned long total_nr_pages, void *arg) |
| { |
| int ret; |
| unsigned long pfn, start_pfn, end_pfn, nr_pages; |
| |
| if ((total_nr_pages * PAGE_SIZE) < EHCA_HUGEPAGE_SIZE) |
| return ehca_update_busmap(initial_pfn, total_nr_pages); |
| |
| /* Given chunk is >= 16GB -> check for hugepages */ |
| start_pfn = initial_pfn; |
| end_pfn = initial_pfn + total_nr_pages; |
| pfn = start_pfn; |
| |
| while (pfn < end_pfn) { |
| if (ehca_is_hugepage(pfn)) { |
| /* Add mem found in front of the hugepage */ |
| nr_pages = pfn - start_pfn; |
| ret = ehca_update_busmap(start_pfn, nr_pages); |
| if (ret) |
| return ret; |
| /* Skip the hugepage */ |
| pfn += (EHCA_HUGEPAGE_SIZE / PAGE_SIZE); |
| start_pfn = pfn; |
| } else |
| pfn += (EHCA_SECTSIZE / PAGE_SIZE); |
| } |
| |
| /* Add mem found behind the hugepage(s) */ |
| nr_pages = pfn - start_pfn; |
| return ehca_update_busmap(start_pfn, nr_pages); |
| } |
| |
| int ehca_create_busmap(void) |
| { |
| int ret; |
| |
| ehca_mr_len = 0; |
| ret = walk_system_ram_range(0, 1ULL << MAX_PHYSMEM_BITS, NULL, |
| ehca_create_busmap_callback); |
| return ret; |
| } |
| |
| static int ehca_reg_bmap_mr_rpages(struct ehca_shca *shca, |
| struct ehca_mr *e_mr, |
| struct ehca_mr_pginfo *pginfo) |
| { |
| int top; |
| u64 hret, *kpage; |
| |
| kpage = ehca_alloc_fw_ctrlblock(GFP_KERNEL); |
| if (!kpage) { |
| ehca_err(&shca->ib_device, "kpage alloc failed"); |
| return -ENOMEM; |
| } |
| for (top = 0; top < EHCA_MAP_ENTRIES; top++) { |
| if (!ehca_bmap_valid(ehca_bmap->top[top])) |
| continue; |
| hret = ehca_reg_mr_dir_sections(top, kpage, shca, e_mr, pginfo); |
| if ((hret != H_PAGE_REGISTERED) && (hret != H_SUCCESS)) |
| break; |
| } |
| |
| ehca_free_fw_ctrlblock(kpage); |
| |
| if (hret == H_SUCCESS) |
| return 0; /* Everything is fine */ |
| else { |
| ehca_err(&shca->ib_device, "ehca_reg_bmap_mr_rpages failed, " |
| "h_ret=%lli e_mr=%p top=%x lkey=%x " |
| "hca_hndl=%llx mr_hndl=%llx", hret, e_mr, top, |
| e_mr->ib.ib_mr.lkey, |
| shca->ipz_hca_handle.handle, |
| e_mr->ipz_mr_handle.handle); |
| return ehca2ib_return_code(hret); |
| } |
| } |
| |
| static u64 ehca_map_vaddr(void *caddr) |
| { |
| int top, dir, idx; |
| unsigned long abs_addr, offset; |
| u64 entry; |
| |
| if (!ehca_bmap) |
| return EHCA_INVAL_ADDR; |
| |
| abs_addr = __pa(caddr); |
| top = ehca_calc_index(abs_addr, EHCA_TOP_INDEX_SHIFT + EHCA_SECTSHIFT); |
| if (!ehca_bmap_valid(ehca_bmap->top[top])) |
| return EHCA_INVAL_ADDR; |
| |
| dir = ehca_calc_index(abs_addr, EHCA_DIR_INDEX_SHIFT + EHCA_SECTSHIFT); |
| if (!ehca_bmap_valid(ehca_bmap->top[top]->dir[dir])) |
| return EHCA_INVAL_ADDR; |
| |
| idx = ehca_calc_index(abs_addr, EHCA_SECTSHIFT); |
| |
| entry = ehca_bmap->top[top]->dir[dir]->ent[idx]; |
| if (ehca_bmap_valid(entry)) { |
| offset = (unsigned long)caddr & (EHCA_SECTSIZE - 1); |
| return entry | offset; |
| } else |
| return EHCA_INVAL_ADDR; |
| } |
| |
| static int ehca_dma_mapping_error(struct ib_device *dev, u64 dma_addr) |
| { |
| return dma_addr == EHCA_INVAL_ADDR; |
| } |
| |
| static u64 ehca_dma_map_single(struct ib_device *dev, void *cpu_addr, |
| size_t size, enum dma_data_direction direction) |
| { |
| if (cpu_addr) |
| return ehca_map_vaddr(cpu_addr); |
| else |
| return EHCA_INVAL_ADDR; |
| } |
| |
| static void ehca_dma_unmap_single(struct ib_device *dev, u64 addr, size_t size, |
| enum dma_data_direction direction) |
| { |
| /* This is only a stub; nothing to be done here */ |
| } |
| |
| static u64 ehca_dma_map_page(struct ib_device *dev, struct page *page, |
| unsigned long offset, size_t size, |
| enum dma_data_direction direction) |
| { |
| u64 addr; |
| |
| if (offset + size > PAGE_SIZE) |
| return EHCA_INVAL_ADDR; |
| |
| addr = ehca_map_vaddr(page_address(page)); |
| if (!ehca_dma_mapping_error(dev, addr)) |
| addr += offset; |
| |
| return addr; |
| } |
| |
| static void ehca_dma_unmap_page(struct ib_device *dev, u64 addr, size_t size, |
| enum dma_data_direction direction) |
| { |
| /* This is only a stub; nothing to be done here */ |
| } |
| |
| static int ehca_dma_map_sg(struct ib_device *dev, struct scatterlist *sgl, |
| int nents, enum dma_data_direction direction) |
| { |
| struct scatterlist *sg; |
| int i; |
| |
| for_each_sg(sgl, sg, nents, i) { |
| u64 addr; |
| addr = ehca_map_vaddr(sg_virt(sg)); |
| if (ehca_dma_mapping_error(dev, addr)) |
| return 0; |
| |
| sg->dma_address = addr; |
| sg->dma_length = sg->length; |
| } |
| return nents; |
| } |
| |
| static void ehca_dma_unmap_sg(struct ib_device *dev, struct scatterlist *sg, |
| int nents, enum dma_data_direction direction) |
| { |
| /* This is only a stub; nothing to be done here */ |
| } |
| |
| static void ehca_dma_sync_single_for_cpu(struct ib_device *dev, u64 addr, |
| size_t size, |
| enum dma_data_direction dir) |
| { |
| dma_sync_single_for_cpu(dev->dma_device, addr, size, dir); |
| } |
| |
| static void ehca_dma_sync_single_for_device(struct ib_device *dev, u64 addr, |
| size_t size, |
| enum dma_data_direction dir) |
| { |
| dma_sync_single_for_device(dev->dma_device, addr, size, dir); |
| } |
| |
| static void *ehca_dma_alloc_coherent(struct ib_device *dev, size_t size, |
| u64 *dma_handle, gfp_t flag) |
| { |
| struct page *p; |
| void *addr = NULL; |
| u64 dma_addr; |
| |
| p = alloc_pages(flag, get_order(size)); |
| if (p) { |
| addr = page_address(p); |
| dma_addr = ehca_map_vaddr(addr); |
| if (ehca_dma_mapping_error(dev, dma_addr)) { |
| free_pages((unsigned long)addr, get_order(size)); |
| return NULL; |
| } |
| if (dma_handle) |
| *dma_handle = dma_addr; |
| return addr; |
| } |
| return NULL; |
| } |
| |
| static void ehca_dma_free_coherent(struct ib_device *dev, size_t size, |
| void *cpu_addr, u64 dma_handle) |
| { |
| if (cpu_addr && size) |
| free_pages((unsigned long)cpu_addr, get_order(size)); |
| } |
| |
| |
| struct ib_dma_mapping_ops ehca_dma_mapping_ops = { |
| .mapping_error = ehca_dma_mapping_error, |
| .map_single = ehca_dma_map_single, |
| .unmap_single = ehca_dma_unmap_single, |
| .map_page = ehca_dma_map_page, |
| .unmap_page = ehca_dma_unmap_page, |
| .map_sg = ehca_dma_map_sg, |
| .unmap_sg = ehca_dma_unmap_sg, |
| .sync_single_for_cpu = ehca_dma_sync_single_for_cpu, |
| .sync_single_for_device = ehca_dma_sync_single_for_device, |
| .alloc_coherent = ehca_dma_alloc_coherent, |
| .free_coherent = ehca_dma_free_coherent, |
| }; |