1 /* 2 * Copyright (c) 2016 Hisilicon Limited. 3 * 4 * This software is available to you under a choice of one of two 5 * licenses. You may choose to be licensed under the terms of the GNU 6 * General Public License (GPL) Version 2, available from the file 7 * COPYING in the main directory of this source tree, or the 8 * OpenIB.org BSD license below: 9 * 10 * Redistribution and use in source and binary forms, with or 11 * without modification, are permitted provided that the following 12 * conditions are met: 13 * 14 * - Redistributions of source code must retain the above 15 * copyright notice, this list of conditions and the following 16 * disclaimer. 17 * 18 * - Redistributions in binary form must reproduce the above 19 * copyright notice, this list of conditions and the following 20 * disclaimer in the documentation and/or other materials 21 * provided with the distribution. 22 * 23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 30 * SOFTWARE. 31 */ 32 33 #include <linux/platform_device.h> 34 #include <rdma/ib_addr.h> 35 #include <rdma/ib_cache.h> 36 #include "hns_roce_device.h" 37 38 #define HNS_ROCE_PORT_NUM_SHIFT 24 39 #define HNS_ROCE_VLAN_SL_BIT_MASK 7 40 #define HNS_ROCE_VLAN_SL_SHIFT 13 41 42 struct ib_ah *hns_roce_create_ah(struct ib_pd *ibpd, 43 struct rdma_ah_attr *ah_attr, 44 struct ib_udata *udata) 45 { 46 struct hns_roce_dev *hr_dev = to_hr_dev(ibpd->device); 47 struct device *dev = hr_dev->dev; 48 struct ib_gid_attr gid_attr; 49 struct hns_roce_ah *ah; 50 u16 vlan_tag = 0xffff; 51 const struct ib_global_route *grh = rdma_ah_read_grh(ah_attr); 52 union ib_gid sgid; 53 int ret; 54 55 ah = kzalloc(sizeof(*ah), GFP_ATOMIC); 56 if (!ah) 57 return ERR_PTR(-ENOMEM); 58 59 /* Get mac address */ 60 memcpy(ah->av.mac, ah_attr->roce.dmac, ETH_ALEN); 61 62 /* Get source gid */ 63 ret = ib_get_cached_gid(ibpd->device, rdma_ah_get_port_num(ah_attr), 64 grh->sgid_index, &sgid, &gid_attr); 65 if (ret) { 66 dev_err(dev, "get sgid failed! ret = %d\n", ret); 67 kfree(ah); 68 return ERR_PTR(ret); 69 } 70 71 if (is_vlan_dev(gid_attr.ndev)) 72 vlan_tag = vlan_dev_vlan_id(gid_attr.ndev); 73 dev_put(gid_attr.ndev); 74 75 if (vlan_tag < 0x1000) 76 vlan_tag |= (rdma_ah_get_sl(ah_attr) & 77 HNS_ROCE_VLAN_SL_BIT_MASK) << 78 HNS_ROCE_VLAN_SL_SHIFT; 79 80 ah->av.port_pd = cpu_to_be32(to_hr_pd(ibpd)->pdn | 81 (rdma_ah_get_port_num(ah_attr) << 82 HNS_ROCE_PORT_NUM_SHIFT)); 83 ah->av.gid_index = grh->sgid_index; 84 ah->av.vlan = cpu_to_le16(vlan_tag); 85 dev_dbg(dev, "gid_index = 0x%x,vlan = 0x%x\n", ah->av.gid_index, 86 ah->av.vlan); 87 88 if (rdma_ah_get_static_rate(ah_attr)) 89 ah->av.stat_rate = IB_RATE_10_GBPS; 90 91 memcpy(ah->av.dgid, grh->dgid.raw, HNS_ROCE_GID_SIZE); 92 ah->av.sl_tclass_flowlabel = cpu_to_le32(rdma_ah_get_sl(ah_attr) << 93 HNS_ROCE_SL_SHIFT); 94 95 return &ah->ibah; 96 } 97 98 int hns_roce_query_ah(struct ib_ah *ibah, struct rdma_ah_attr *ah_attr) 99 { 100 struct hns_roce_ah *ah = to_hr_ah(ibah); 101 102 memset(ah_attr, 0, sizeof(*ah_attr)); 103 104 rdma_ah_set_sl(ah_attr, (le32_to_cpu(ah->av.sl_tclass_flowlabel) >> 105 HNS_ROCE_SL_SHIFT)); 106 rdma_ah_set_port_num(ah_attr, (le32_to_cpu(ah->av.port_pd) >> 107 HNS_ROCE_PORT_NUM_SHIFT)); 108 rdma_ah_set_static_rate(ah_attr, ah->av.stat_rate); 109 rdma_ah_set_grh(ah_attr, NULL, 110 (le32_to_cpu(ah->av.sl_tclass_flowlabel) & 111 HNS_ROCE_FLOW_LABLE_MASK), ah->av.gid_index, 112 ah->av.hop_limit, 113 (le32_to_cpu(ah->av.sl_tclass_flowlabel) >> 114 HNS_ROCE_TCLASS_SHIFT)); 115 rdma_ah_set_dgid_raw(ah_attr, ah->av.dgid); 116 117 return 0; 118 } 119 120 int hns_roce_destroy_ah(struct ib_ah *ah) 121 { 122 kfree(to_hr_ah(ah)); 123 124 return 0; 125 } 126