1 | /* |
2 | * Copyright (c) 2007 Cisco Systems, Inc. All rights reserved. |
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 <rdma/ib_addr.h> |
34 | #include <rdma/ib_cache.h> |
35 | |
36 | #include <linux/slab.h> |
37 | #include <linux/inet.h> |
38 | #include <linux/string.h> |
39 | #include <linux/mlx4/driver.h> |
40 | |
41 | #include "mlx4_ib.h" |
42 | |
43 | static void create_ib_ah(struct ib_ah *ib_ah, struct rdma_ah_attr *ah_attr) |
44 | { |
45 | struct mlx4_ib_ah *ah = to_mah(ibah: ib_ah); |
46 | struct mlx4_dev *dev = to_mdev(ibdev: ib_ah->device)->dev; |
47 | |
48 | ah->av.ib.port_pd = cpu_to_be32(to_mpd(ib_ah->pd)->pdn | |
49 | (rdma_ah_get_port_num(ah_attr) << 24)); |
50 | ah->av.ib.g_slid = rdma_ah_get_path_bits(attr: ah_attr); |
51 | ah->av.ib.sl_tclass_flowlabel = |
52 | cpu_to_be32(rdma_ah_get_sl(ah_attr) << 28); |
53 | if (rdma_ah_get_ah_flags(attr: ah_attr) & IB_AH_GRH) { |
54 | const struct ib_global_route *grh = rdma_ah_read_grh(attr: ah_attr); |
55 | |
56 | ah->av.ib.g_slid |= 0x80; |
57 | ah->av.ib.gid_index = grh->sgid_index; |
58 | ah->av.ib.hop_limit = grh->hop_limit; |
59 | ah->av.ib.sl_tclass_flowlabel |= |
60 | cpu_to_be32((grh->traffic_class << 20) | |
61 | grh->flow_label); |
62 | memcpy(ah->av.ib.dgid, grh->dgid.raw, 16); |
63 | } |
64 | |
65 | ah->av.ib.dlid = cpu_to_be16(rdma_ah_get_dlid(ah_attr)); |
66 | if (rdma_ah_get_static_rate(attr: ah_attr)) { |
67 | u8 static_rate = rdma_ah_get_static_rate(attr: ah_attr) + |
68 | MLX4_STAT_RATE_OFFSET; |
69 | |
70 | while (static_rate > IB_RATE_2_5_GBPS + MLX4_STAT_RATE_OFFSET && |
71 | !(1 << static_rate & dev->caps.stat_rate_support)) |
72 | --static_rate; |
73 | ah->av.ib.stat_rate = static_rate; |
74 | } |
75 | } |
76 | |
77 | static int create_iboe_ah(struct ib_ah *ib_ah, struct rdma_ah_attr *ah_attr) |
78 | { |
79 | struct mlx4_ib_dev *ibdev = to_mdev(ibdev: ib_ah->device); |
80 | struct mlx4_ib_ah *ah = to_mah(ibah: ib_ah); |
81 | const struct ib_gid_attr *gid_attr; |
82 | struct mlx4_dev *dev = ibdev->dev; |
83 | int is_mcast = 0; |
84 | struct in6_addr in6; |
85 | u16 vlan_tag = 0xffff; |
86 | const struct ib_global_route *grh = rdma_ah_read_grh(attr: ah_attr); |
87 | int ret; |
88 | |
89 | memcpy(&in6, grh->dgid.raw, sizeof(in6)); |
90 | if (rdma_is_multicast_addr(addr: &in6)) |
91 | is_mcast = 1; |
92 | |
93 | memcpy(ah->av.eth.mac, ah_attr->roce.dmac, ETH_ALEN); |
94 | eth_zero_addr(addr: ah->av.eth.s_mac); |
95 | |
96 | /* |
97 | * If sgid_attr is NULL we are being called by mlx4_ib_create_ah_slave |
98 | * and we are directly creating an AV for a slave's gid_index. |
99 | */ |
100 | gid_attr = ah_attr->grh.sgid_attr; |
101 | if (gid_attr) { |
102 | ret = rdma_read_gid_l2_fields(attr: gid_attr, vlan_id: &vlan_tag, |
103 | smac: &ah->av.eth.s_mac[0]); |
104 | if (ret) |
105 | return ret; |
106 | |
107 | ret = mlx4_ib_gid_index_to_real_index(ibdev, attr: gid_attr); |
108 | if (ret < 0) |
109 | return ret; |
110 | ah->av.eth.gid_index = ret; |
111 | } else { |
112 | /* mlx4_ib_create_ah_slave fills in the s_mac and the vlan */ |
113 | ah->av.eth.gid_index = ah_attr->grh.sgid_index; |
114 | } |
115 | |
116 | if (vlan_tag < 0x1000) |
117 | vlan_tag |= (rdma_ah_get_sl(attr: ah_attr) & 7) << 13; |
118 | ah->av.eth.port_pd = cpu_to_be32(to_mpd(ib_ah->pd)->pdn | |
119 | (rdma_ah_get_port_num(ah_attr) << 24)); |
120 | ah->av.eth.vlan = cpu_to_be16(vlan_tag); |
121 | ah->av.eth.hop_limit = grh->hop_limit; |
122 | if (rdma_ah_get_static_rate(attr: ah_attr)) { |
123 | ah->av.eth.stat_rate = rdma_ah_get_static_rate(attr: ah_attr) + |
124 | MLX4_STAT_RATE_OFFSET; |
125 | while (ah->av.eth.stat_rate > IB_RATE_2_5_GBPS + MLX4_STAT_RATE_OFFSET && |
126 | !(1 << ah->av.eth.stat_rate & dev->caps.stat_rate_support)) |
127 | --ah->av.eth.stat_rate; |
128 | } |
129 | ah->av.eth.sl_tclass_flowlabel |= |
130 | cpu_to_be32((grh->traffic_class << 20) | |
131 | grh->flow_label); |
132 | /* |
133 | * HW requires multicast LID so we just choose one. |
134 | */ |
135 | if (is_mcast) |
136 | ah->av.ib.dlid = cpu_to_be16(0xc000); |
137 | |
138 | memcpy(ah->av.eth.dgid, grh->dgid.raw, 16); |
139 | ah->av.eth.sl_tclass_flowlabel |= cpu_to_be32(rdma_ah_get_sl(ah_attr) |
140 | << 29); |
141 | return 0; |
142 | } |
143 | |
144 | int mlx4_ib_create_ah(struct ib_ah *ib_ah, struct rdma_ah_init_attr *init_attr, |
145 | struct ib_udata *udata) |
146 | { |
147 | struct rdma_ah_attr *ah_attr = init_attr->ah_attr; |
148 | |
149 | if (ah_attr->type == RDMA_AH_ATTR_TYPE_ROCE) { |
150 | if (!(rdma_ah_get_ah_flags(attr: ah_attr) & IB_AH_GRH)) |
151 | return -EINVAL; |
152 | /* |
153 | * TBD: need to handle the case when we get |
154 | * called in an atomic context and there we |
155 | * might sleep. We don't expect this |
156 | * currently since we're working with link |
157 | * local addresses which we can translate |
158 | * without going to sleep. |
159 | */ |
160 | return create_iboe_ah(ib_ah, ah_attr); |
161 | } |
162 | |
163 | create_ib_ah(ib_ah, ah_attr); |
164 | return 0; |
165 | } |
166 | |
167 | int mlx4_ib_create_ah_slave(struct ib_ah *ah, struct rdma_ah_attr *ah_attr, |
168 | int slave_sgid_index, u8 *s_mac, u16 vlan_tag) |
169 | { |
170 | struct rdma_ah_attr slave_attr = *ah_attr; |
171 | struct rdma_ah_init_attr init_attr = {}; |
172 | struct mlx4_ib_ah *mah = to_mah(ibah: ah); |
173 | int ret; |
174 | |
175 | slave_attr.grh.sgid_attr = NULL; |
176 | slave_attr.grh.sgid_index = slave_sgid_index; |
177 | init_attr.ah_attr = &slave_attr; |
178 | ret = mlx4_ib_create_ah(ib_ah: ah, init_attr: &init_attr, NULL); |
179 | if (ret) |
180 | return ret; |
181 | |
182 | ah->type = ah_attr->type; |
183 | |
184 | /* get rid of force-loopback bit */ |
185 | mah->av.ib.port_pd &= cpu_to_be32(0x7FFFFFFF); |
186 | |
187 | if (ah_attr->type == RDMA_AH_ATTR_TYPE_ROCE) |
188 | memcpy(mah->av.eth.s_mac, s_mac, 6); |
189 | |
190 | if (vlan_tag < 0x1000) |
191 | vlan_tag |= (rdma_ah_get_sl(attr: ah_attr) & 7) << 13; |
192 | mah->av.eth.vlan = cpu_to_be16(vlan_tag); |
193 | |
194 | return 0; |
195 | } |
196 | |
197 | int mlx4_ib_query_ah(struct ib_ah *ibah, struct rdma_ah_attr *ah_attr) |
198 | { |
199 | struct mlx4_ib_ah *ah = to_mah(ibah); |
200 | int port_num = be32_to_cpu(ah->av.ib.port_pd) >> 24; |
201 | |
202 | memset(ah_attr, 0, sizeof *ah_attr); |
203 | ah_attr->type = ibah->type; |
204 | |
205 | if (ah_attr->type == RDMA_AH_ATTR_TYPE_ROCE) { |
206 | rdma_ah_set_dlid(attr: ah_attr, dlid: 0); |
207 | rdma_ah_set_sl(attr: ah_attr, |
208 | be32_to_cpu(ah->av.eth.sl_tclass_flowlabel) |
209 | >> 29); |
210 | } else { |
211 | rdma_ah_set_dlid(attr: ah_attr, be16_to_cpu(ah->av.ib.dlid)); |
212 | rdma_ah_set_sl(attr: ah_attr, |
213 | be32_to_cpu(ah->av.ib.sl_tclass_flowlabel) |
214 | >> 28); |
215 | } |
216 | |
217 | rdma_ah_set_port_num(attr: ah_attr, port_num); |
218 | if (ah->av.ib.stat_rate) |
219 | rdma_ah_set_static_rate(attr: ah_attr, |
220 | static_rate: ah->av.ib.stat_rate - |
221 | MLX4_STAT_RATE_OFFSET); |
222 | rdma_ah_set_path_bits(attr: ah_attr, src_path_bits: ah->av.ib.g_slid & 0x7F); |
223 | if (mlx4_ib_ah_grh_present(ah)) { |
224 | u32 tc_fl = be32_to_cpu(ah->av.ib.sl_tclass_flowlabel); |
225 | |
226 | rdma_ah_set_grh(attr: ah_attr, NULL, |
227 | flow_label: tc_fl & 0xfffff, sgid_index: ah->av.ib.gid_index, |
228 | hop_limit: ah->av.ib.hop_limit, |
229 | traffic_class: tc_fl >> 20); |
230 | rdma_ah_set_dgid_raw(attr: ah_attr, dgid: ah->av.ib.dgid); |
231 | } |
232 | |
233 | return 0; |
234 | } |
235 | |