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 static inline u16 get_ah_udp_sport(const struct rdma_ah_attr *ah_attr) 43 { 44 u32 fl = ah_attr->grh.flow_label; 45 u16 sport; 46 47 if (!fl) 48 sport = get_random_u32() % 49 (IB_ROCE_UDP_ENCAP_VALID_PORT_MAX + 1 - 50 IB_ROCE_UDP_ENCAP_VALID_PORT_MIN) + 51 IB_ROCE_UDP_ENCAP_VALID_PORT_MIN; 52 else 53 sport = rdma_flow_label_to_udp_sport(fl); 54 55 return sport; 56 } 57 58 int hns_roce_create_ah(struct ib_ah *ibah, struct rdma_ah_init_attr *init_attr, 59 struct ib_udata *udata) 60 { 61 struct hns_roce_dev *hr_dev = to_hr_dev(ibah->device); 62 const struct ib_gid_attr *gid_attr; 63 struct device *dev = hr_dev->dev; 64 struct hns_roce_ah *ah = to_hr_ah(ibah); 65 struct rdma_ah_attr *ah_attr = init_attr->ah_attr; 66 const struct ib_global_route *grh = rdma_ah_read_grh(ah_attr); 67 u16 vlan_id = 0xffff; 68 bool vlan_en = false; 69 int ret; 70 71 gid_attr = ah_attr->grh.sgid_attr; 72 ret = rdma_read_gid_l2_fields(gid_attr, &vlan_id, NULL); 73 if (ret) 74 return ret; 75 76 /* Get mac address */ 77 memcpy(ah->av.mac, ah_attr->roce.dmac, ETH_ALEN); 78 79 if (vlan_id < VLAN_N_VID) { 80 vlan_en = true; 81 vlan_id |= (rdma_ah_get_sl(ah_attr) & 82 HNS_ROCE_VLAN_SL_BIT_MASK) << 83 HNS_ROCE_VLAN_SL_SHIFT; 84 } 85 86 ah->av.port = rdma_ah_get_port_num(ah_attr); 87 ah->av.gid_index = grh->sgid_index; 88 ah->av.vlan_id = vlan_id; 89 ah->av.vlan_en = vlan_en; 90 dev_dbg(dev, "gid_index = 0x%x,vlan_id = 0x%x\n", ah->av.gid_index, 91 ah->av.vlan_id); 92 93 if (rdma_ah_get_static_rate(ah_attr)) 94 ah->av.stat_rate = IB_RATE_10_GBPS; 95 96 memcpy(ah->av.dgid, grh->dgid.raw, HNS_ROCE_GID_SIZE); 97 ah->av.sl = rdma_ah_get_sl(ah_attr); 98 ah->av.flowlabel = grh->flow_label; 99 ah->av.udp_sport = get_ah_udp_sport(ah_attr); 100 101 return 0; 102 } 103 104 int hns_roce_query_ah(struct ib_ah *ibah, struct rdma_ah_attr *ah_attr) 105 { 106 struct hns_roce_ah *ah = to_hr_ah(ibah); 107 108 memset(ah_attr, 0, sizeof(*ah_attr)); 109 110 rdma_ah_set_sl(ah_attr, ah->av.sl); 111 rdma_ah_set_port_num(ah_attr, ah->av.port); 112 rdma_ah_set_static_rate(ah_attr, ah->av.stat_rate); 113 rdma_ah_set_grh(ah_attr, NULL, ah->av.flowlabel, 114 ah->av.gid_index, ah->av.hop_limit, ah->av.tclass); 115 rdma_ah_set_dgid_raw(ah_attr, ah->av.dgid); 116 117 return 0; 118 } 119