1 /*- 2 * Copyright (c) 2013-2015, Mellanox Technologies, Ltd. All rights reserved. 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 1. Redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer. 9 * 2. Redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution. 12 * 13 * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS `AS IS' AND 14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16 * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE 17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23 * SUCH DAMAGE. 24 * 25 * $FreeBSD$ 26 */ 27 28 #include "mlx5_ib.h" 29 30 static struct ib_ah *create_ib_ah(struct mlx5_ib_dev *dev, 31 struct mlx5_ib_ah *ah, 32 struct ib_ah_attr *ah_attr, 33 enum rdma_link_layer ll) 34 { 35 if (ah_attr->ah_flags & IB_AH_GRH) { 36 memcpy(ah->av.rgid, &ah_attr->grh.dgid, 16); 37 ah->av.grh_gid_fl = cpu_to_be32(ah_attr->grh.flow_label | 38 (1 << 30) | 39 ah_attr->grh.sgid_index << 20); 40 ah->av.hop_limit = ah_attr->grh.hop_limit; 41 ah->av.tclass = ah_attr->grh.traffic_class; 42 } 43 44 ah->av.stat_rate_sl = (ah_attr->static_rate << 4); 45 46 if (ll == IB_LINK_LAYER_ETHERNET) { 47 memcpy(ah->av.rmac, ah_attr->dmac, sizeof(ah_attr->dmac)); 48 ah->av.udp_sport = 49 mlx5_get_roce_udp_sport(dev, 50 ah_attr->port_num, 51 ah_attr->grh.sgid_index); 52 ah->av.stat_rate_sl |= (ah_attr->sl & 0x7) << 1; 53 } else { 54 ah->av.rlid = cpu_to_be16(ah_attr->dlid); 55 ah->av.fl_mlid = ah_attr->src_path_bits & 0x7f; 56 ah->av.stat_rate_sl |= (ah_attr->sl & 0xf); 57 } 58 59 return &ah->ibah; 60 } 61 62 struct ib_ah *mlx5_ib_create_ah(struct ib_pd *pd, struct ib_ah_attr *ah_attr, 63 struct ib_udata *udata) 64 65 { 66 struct mlx5_ib_ah *ah; 67 struct mlx5_ib_dev *dev = to_mdev(pd->device); 68 enum rdma_link_layer ll; 69 70 ll = pd->device->get_link_layer(pd->device, ah_attr->port_num); 71 72 if (ll == IB_LINK_LAYER_ETHERNET && !(ah_attr->ah_flags & IB_AH_GRH)) 73 return ERR_PTR(-EINVAL); 74 75 if (ll == IB_LINK_LAYER_ETHERNET && udata) { 76 int err; 77 struct mlx5_ib_create_ah_resp resp = {}; 78 u32 min_resp_len = offsetof(typeof(resp), dmac) + 79 sizeof(resp.dmac); 80 81 if (udata->outlen < min_resp_len) 82 return ERR_PTR(-EINVAL); 83 84 resp.response_length = min_resp_len; 85 86 err = ib_resolve_eth_dmac(pd->device, ah_attr); 87 if (err) 88 return ERR_PTR(err); 89 90 memcpy(resp.dmac, ah_attr->dmac, ETH_ALEN); 91 err = ib_copy_to_udata(udata, &resp, resp.response_length); 92 if (err) 93 return ERR_PTR(err); 94 } 95 96 ah = kzalloc(sizeof(*ah), GFP_ATOMIC); 97 if (!ah) 98 return ERR_PTR(-ENOMEM); 99 100 return create_ib_ah(dev, ah, ah_attr, ll); /* never fails */ 101 } 102 103 int mlx5_ib_query_ah(struct ib_ah *ibah, struct ib_ah_attr *ah_attr) 104 { 105 struct mlx5_ib_ah *ah = to_mah(ibah); 106 u32 tmp; 107 108 memset(ah_attr, 0, sizeof(*ah_attr)); 109 110 tmp = be32_to_cpu(ah->av.grh_gid_fl); 111 if (tmp & (1 << 30)) { 112 ah_attr->ah_flags = IB_AH_GRH; 113 ah_attr->grh.sgid_index = (tmp >> 20) & 0xff; 114 ah_attr->grh.flow_label = tmp & 0xfffff; 115 memcpy(&ah_attr->grh.dgid, ah->av.rgid, 16); 116 ah_attr->grh.hop_limit = ah->av.hop_limit; 117 ah_attr->grh.traffic_class = ah->av.tclass; 118 } 119 ah_attr->dlid = be16_to_cpu(ah->av.rlid); 120 ah_attr->static_rate = ah->av.stat_rate_sl >> 4; 121 ah_attr->sl = ah->av.stat_rate_sl & 0xf; 122 123 return 0; 124 } 125 126 int mlx5_ib_destroy_ah(struct ib_ah *ah) 127 { 128 kfree(to_mah(ah)); 129 return 0; 130 } 131