1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
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
42int hns_roce_create_ah(struct ib_ah *ibah, struct rdma_ah_attr *ah_attr,
43 u32 flags, struct ib_udata *udata)
44{
45 struct hns_roce_dev *hr_dev = to_hr_dev(ibah->device);
46 const struct ib_gid_attr *gid_attr;
47 struct device *dev = hr_dev->dev;
48 struct hns_roce_ah *ah = to_hr_ah(ibah);
49 const struct ib_global_route *grh = rdma_ah_read_grh(ah_attr);
50 u16 vlan_id = 0xffff;
51 bool vlan_en = false;
52 int ret;
53
54 gid_attr = ah_attr->grh.sgid_attr;
55 ret = rdma_read_gid_l2_fields(gid_attr, &vlan_id, NULL);
56 if (ret)
57 return ret;
58
59
60 memcpy(ah->av.mac, ah_attr->roce.dmac, ETH_ALEN);
61
62 if (vlan_id < VLAN_N_VID) {
63 vlan_en = true;
64 vlan_id |= (rdma_ah_get_sl(ah_attr) &
65 HNS_ROCE_VLAN_SL_BIT_MASK) <<
66 HNS_ROCE_VLAN_SL_SHIFT;
67 }
68
69 ah->av.port = rdma_ah_get_port_num(ah_attr);
70 ah->av.gid_index = grh->sgid_index;
71 ah->av.vlan_id = vlan_id;
72 ah->av.vlan_en = vlan_en;
73 dev_dbg(dev, "gid_index = 0x%x,vlan_id = 0x%x\n", ah->av.gid_index,
74 ah->av.vlan_id);
75
76 if (rdma_ah_get_static_rate(ah_attr))
77 ah->av.stat_rate = IB_RATE_10_GBPS;
78
79 memcpy(ah->av.dgid, grh->dgid.raw, HNS_ROCE_GID_SIZE);
80 ah->av.sl = rdma_ah_get_sl(ah_attr);
81
82 return 0;
83}
84
85int hns_roce_query_ah(struct ib_ah *ibah, struct rdma_ah_attr *ah_attr)
86{
87 struct hns_roce_ah *ah = to_hr_ah(ibah);
88
89 memset(ah_attr, 0, sizeof(*ah_attr));
90
91 rdma_ah_set_sl(ah_attr, ah->av.sl);
92 rdma_ah_set_port_num(ah_attr, ah->av.port);
93 rdma_ah_set_static_rate(ah_attr, ah->av.stat_rate);
94 rdma_ah_set_grh(ah_attr, NULL, ah->av.flowlabel,
95 ah->av.gid_index, ah->av.hop_limit, ah->av.tclass);
96 rdma_ah_set_dgid_raw(ah_attr, ah->av.dgid);
97
98 return 0;
99}
100
101void hns_roce_destroy_ah(struct ib_ah *ah, u32 flags)
102{
103 return;
104}
105