1 | /* |
2 | * Copyright (c) 2013-2015, Mellanox Technologies. 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 "mlx5_ib.h" |
34 | |
35 | static __be16 mlx5_ah_get_udp_sport(const struct mlx5_ib_dev *dev, |
36 | const struct rdma_ah_attr *ah_attr) |
37 | { |
38 | enum ib_gid_type gid_type = ah_attr->grh.sgid_attr->gid_type; |
39 | __be16 sport; |
40 | |
41 | if ((gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) && |
42 | (rdma_ah_get_ah_flags(attr: ah_attr) & IB_AH_GRH) && |
43 | (ah_attr->grh.flow_label & IB_GRH_FLOWLABEL_MASK)) |
44 | sport = cpu_to_be16( |
45 | rdma_flow_label_to_udp_sport(ah_attr->grh.flow_label)); |
46 | else |
47 | sport = mlx5_get_roce_udp_sport_min(dev, |
48 | attr: ah_attr->grh.sgid_attr); |
49 | |
50 | return sport; |
51 | } |
52 | |
53 | static void create_ib_ah(struct mlx5_ib_dev *dev, struct mlx5_ib_ah *ah, |
54 | struct rdma_ah_init_attr *init_attr) |
55 | { |
56 | struct rdma_ah_attr *ah_attr = init_attr->ah_attr; |
57 | enum ib_gid_type gid_type; |
58 | |
59 | if (rdma_ah_get_ah_flags(attr: ah_attr) & IB_AH_GRH) { |
60 | const struct ib_global_route *grh = rdma_ah_read_grh(attr: ah_attr); |
61 | |
62 | memcpy(ah->av.rgid, &grh->dgid, 16); |
63 | ah->av.grh_gid_fl = cpu_to_be32(grh->flow_label | |
64 | (1 << 30) | |
65 | grh->sgid_index << 20); |
66 | ah->av.hop_limit = grh->hop_limit; |
67 | ah->av.tclass = grh->traffic_class; |
68 | } |
69 | |
70 | ah->av.stat_rate_sl = (rdma_ah_get_static_rate(attr: ah_attr) << 4); |
71 | |
72 | if (ah_attr->type == RDMA_AH_ATTR_TYPE_ROCE) { |
73 | if (init_attr->xmit_slave) |
74 | ah->xmit_port = |
75 | mlx5_lag_get_slave_port(dev: dev->mdev, |
76 | slave: init_attr->xmit_slave); |
77 | gid_type = ah_attr->grh.sgid_attr->gid_type; |
78 | |
79 | memcpy(ah->av.rmac, ah_attr->roce.dmac, |
80 | sizeof(ah_attr->roce.dmac)); |
81 | ah->av.udp_sport = mlx5_ah_get_udp_sport(dev, ah_attr); |
82 | ah->av.stat_rate_sl |= (rdma_ah_get_sl(attr: ah_attr) & 0x7) << 1; |
83 | if (gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) |
84 | #define MLX5_ECN_ENABLED BIT(1) |
85 | ah->av.tclass |= MLX5_ECN_ENABLED; |
86 | } else { |
87 | ah->av.rlid = cpu_to_be16(rdma_ah_get_dlid(ah_attr)); |
88 | ah->av.fl_mlid = rdma_ah_get_path_bits(attr: ah_attr) & 0x7f; |
89 | ah->av.stat_rate_sl |= (rdma_ah_get_sl(attr: ah_attr) & 0xf); |
90 | } |
91 | } |
92 | |
93 | int mlx5_ib_create_ah(struct ib_ah *ibah, struct rdma_ah_init_attr *init_attr, |
94 | struct ib_udata *udata) |
95 | |
96 | { |
97 | struct rdma_ah_attr *ah_attr = init_attr->ah_attr; |
98 | struct mlx5_ib_ah *ah = to_mah(ibah); |
99 | struct mlx5_ib_dev *dev = to_mdev(ibdev: ibah->device); |
100 | enum rdma_ah_attr_type ah_type = ah_attr->type; |
101 | |
102 | if ((ah_type == RDMA_AH_ATTR_TYPE_ROCE) && |
103 | !(rdma_ah_get_ah_flags(attr: ah_attr) & IB_AH_GRH)) |
104 | return -EINVAL; |
105 | |
106 | if (ah_type == RDMA_AH_ATTR_TYPE_ROCE && udata) { |
107 | int err; |
108 | struct mlx5_ib_create_ah_resp resp = {}; |
109 | u32 min_resp_len = |
110 | offsetofend(struct mlx5_ib_create_ah_resp, dmac); |
111 | |
112 | if (udata->outlen < min_resp_len) |
113 | return -EINVAL; |
114 | |
115 | resp.response_length = min_resp_len; |
116 | |
117 | memcpy(resp.dmac, ah_attr->roce.dmac, ETH_ALEN); |
118 | err = ib_copy_to_udata(udata, src: &resp, len: resp.response_length); |
119 | if (err) |
120 | return err; |
121 | } |
122 | |
123 | create_ib_ah(dev, ah, init_attr); |
124 | return 0; |
125 | } |
126 | |
127 | int mlx5_ib_query_ah(struct ib_ah *ibah, struct rdma_ah_attr *ah_attr) |
128 | { |
129 | struct mlx5_ib_ah *ah = to_mah(ibah); |
130 | u32 tmp; |
131 | |
132 | memset(ah_attr, 0, sizeof(*ah_attr)); |
133 | ah_attr->type = ibah->type; |
134 | |
135 | tmp = be32_to_cpu(ah->av.grh_gid_fl); |
136 | if (tmp & (1 << 30)) { |
137 | rdma_ah_set_grh(attr: ah_attr, NULL, |
138 | flow_label: tmp & 0xfffff, |
139 | sgid_index: (tmp >> 20) & 0xff, |
140 | hop_limit: ah->av.hop_limit, |
141 | traffic_class: ah->av.tclass); |
142 | rdma_ah_set_dgid_raw(attr: ah_attr, dgid: ah->av.rgid); |
143 | } |
144 | rdma_ah_set_dlid(attr: ah_attr, be16_to_cpu(ah->av.rlid)); |
145 | rdma_ah_set_static_rate(attr: ah_attr, static_rate: ah->av.stat_rate_sl >> 4); |
146 | rdma_ah_set_sl(attr: ah_attr, sl: ah->av.stat_rate_sl & 0xf); |
147 | |
148 | return 0; |
149 | } |
150 | |