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