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, struct ib_ah_attr *ah_attr, 43 struct ib_udata *udata) 44 { 45 struct hns_roce_dev *hr_dev = to_hr_dev(ibpd->device); 46 struct device *dev = &hr_dev->pdev->dev; 47 struct ib_gid_attr gid_attr; 48 struct hns_roce_ah *ah; 49 u16 vlan_tag = 0xffff; 50 struct in6_addr in6; 51 union ib_gid sgid; 52 int ret; 53 54 ah = kzalloc(sizeof(*ah), GFP_ATOMIC); 55 if (!ah) 56 return ERR_PTR(-ENOMEM); 57 58 /* Get mac address */ 59 memcpy(&in6, ah_attr->grh.dgid.raw, sizeof(ah_attr->grh.dgid.raw)); 60 if (rdma_is_multicast_addr(&in6)) 61 rdma_get_mcast_mac(&in6, ah->av.mac); 62 else 63 memcpy(ah->av.mac, ah_attr->dmac, sizeof(ah_attr->dmac)); 64 65 /* Get source gid */ 66 ret = ib_get_cached_gid(ibpd->device, ah_attr->port_num, 67 ah_attr->grh.sgid_index, &sgid, &gid_attr); 68 if (ret) { 69 dev_err(dev, "get sgid failed! ret = %d\n", ret); 70 kfree(ah); 71 return ERR_PTR(ret); 72 } 73 74 if (gid_attr.ndev) { 75 if (is_vlan_dev(gid_attr.ndev)) 76 vlan_tag = vlan_dev_vlan_id(gid_attr.ndev); 77 dev_put(gid_attr.ndev); 78 } 79 80 if (vlan_tag < 0x1000) 81 vlan_tag |= (ah_attr->sl & HNS_ROCE_VLAN_SL_BIT_MASK) << 82 HNS_ROCE_VLAN_SL_SHIFT; 83 84 ah->av.port_pd = cpu_to_be32(to_hr_pd(ibpd)->pdn | (ah_attr->port_num << 85 HNS_ROCE_PORT_NUM_SHIFT)); 86 ah->av.gid_index = ah_attr->grh.sgid_index; 87 ah->av.vlan = cpu_to_le16(vlan_tag); 88 dev_dbg(dev, "gid_index = 0x%x,vlan = 0x%x\n", ah->av.gid_index, 89 ah->av.vlan); 90 91 if (ah_attr->static_rate) 92 ah->av.stat_rate = IB_RATE_10_GBPS; 93 94 memcpy(ah->av.dgid, ah_attr->grh.dgid.raw, HNS_ROCE_GID_SIZE); 95 ah->av.sl_tclass_flowlabel = cpu_to_le32(ah_attr->sl << 96 HNS_ROCE_SL_SHIFT); 97 98 return &ah->ibah; 99 } 100 101 int hns_roce_query_ah(struct ib_ah *ibah, struct ib_ah_attr *ah_attr) 102 { 103 struct hns_roce_ah *ah = to_hr_ah(ibah); 104 105 memset(ah_attr, 0, sizeof(*ah_attr)); 106 107 ah_attr->sl = le32_to_cpu(ah->av.sl_tclass_flowlabel) >> 108 HNS_ROCE_SL_SHIFT; 109 ah_attr->port_num = le32_to_cpu(ah->av.port_pd) >> 110 HNS_ROCE_PORT_NUM_SHIFT; 111 ah_attr->static_rate = ah->av.stat_rate; 112 ah_attr->ah_flags = IB_AH_GRH; 113 ah_attr->grh.traffic_class = le32_to_cpu(ah->av.sl_tclass_flowlabel) >> 114 HNS_ROCE_TCLASS_SHIFT; 115 ah_attr->grh.flow_label = le32_to_cpu(ah->av.sl_tclass_flowlabel) & 116 HNS_ROCE_FLOW_LABLE_MASK; 117 ah_attr->grh.hop_limit = ah->av.hop_limit; 118 ah_attr->grh.sgid_index = ah->av.gid_index; 119 memcpy(ah_attr->grh.dgid.raw, ah->av.dgid, HNS_ROCE_GID_SIZE); 120 121 return 0; 122 } 123 124 int hns_roce_destroy_ah(struct ib_ah *ah) 125 { 126 kfree(to_hr_ah(ah)); 127 128 return 0; 129 } 130