1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright 2011 Cisco Systems, Inc. All rights reserved.
3
4 #include <linux/kernel.h>
5 #include <linux/string.h>
6 #include <linux/errno.h>
7 #include <linux/types.h>
8 #include <linux/netdevice.h>
9 #include <linux/etherdevice.h>
10 #include <linux/rtnetlink.h>
11 #include <net/ip.h>
12
13 #include "vnic_vic.h"
14 #include "enic_res.h"
15 #include "enic.h"
16 #include "enic_dev.h"
17 #include "enic_pp.h"
18
19 /*
20 * Checks validity of vf index that came in
21 * port profile request
22 */
enic_is_valid_pp_vf(struct enic * enic,int vf,int * err)23 int enic_is_valid_pp_vf(struct enic *enic, int vf, int *err)
24 {
25 if (vf != PORT_SELF_VF) {
26 #ifdef CONFIG_PCI_IOV
27 if (enic_sriov_enabled(enic)) {
28 if (vf < 0 || vf >= enic->num_vfs) {
29 *err = -EINVAL;
30 goto err_out;
31 }
32 } else {
33 *err = -EOPNOTSUPP;
34 goto err_out;
35 }
36 #else
37 *err = -EOPNOTSUPP;
38 goto err_out;
39 #endif
40 }
41
42 if (vf == PORT_SELF_VF && !enic_is_dynamic(enic)) {
43 *err = -EOPNOTSUPP;
44 goto err_out;
45 }
46
47 *err = 0;
48 return 1;
49
50 err_out:
51 return 0;
52 }
53
enic_set_port_profile(struct enic * enic,int vf)54 static int enic_set_port_profile(struct enic *enic, int vf)
55 {
56 struct net_device *netdev = enic->netdev;
57 struct enic_port_profile *pp;
58 struct vic_provinfo *vp;
59 const u8 oui[3] = VIC_PROVINFO_CISCO_OUI;
60 const __be16 os_type = htons(VIC_GENERIC_PROV_OS_TYPE_LINUX);
61 const u8 *client_mac;
62 char uuid_str[38];
63 char client_mac_str[18];
64 int err;
65
66 ENIC_PP_BY_INDEX(enic, vf, pp, &err);
67 if (err)
68 return err;
69
70 if (!(pp->set & ENIC_SET_NAME) || !strlen(pp->name))
71 return -EINVAL;
72
73 vp = vic_provinfo_alloc(GFP_KERNEL, oui,
74 VIC_PROVINFO_GENERIC_TYPE);
75 if (!vp)
76 return -ENOMEM;
77
78 VIC_PROVINFO_ADD_TLV(vp,
79 VIC_GENERIC_PROV_TLV_PORT_PROFILE_NAME_STR,
80 strlen(pp->name) + 1, pp->name);
81
82 if (!is_zero_ether_addr(pp->mac_addr)) {
83 client_mac = pp->mac_addr;
84 } else if (vf == PORT_SELF_VF) {
85 client_mac = netdev->dev_addr;
86 } else {
87 netdev_err(netdev, "Cannot find pp mac address "
88 "for VF %d\n", vf);
89 err = -EINVAL;
90 goto add_tlv_failure;
91 }
92
93 VIC_PROVINFO_ADD_TLV(vp,
94 VIC_GENERIC_PROV_TLV_CLIENT_MAC_ADDR,
95 ETH_ALEN, client_mac);
96
97 snprintf(client_mac_str, sizeof(client_mac_str), "%pM", client_mac);
98 VIC_PROVINFO_ADD_TLV(vp,
99 VIC_GENERIC_PROV_TLV_CLUSTER_PORT_UUID_STR,
100 sizeof(client_mac_str), client_mac_str);
101
102 if (pp->set & ENIC_SET_INSTANCE) {
103 sprintf(uuid_str, "%pUB", pp->instance_uuid);
104 VIC_PROVINFO_ADD_TLV(vp,
105 VIC_GENERIC_PROV_TLV_CLIENT_UUID_STR,
106 sizeof(uuid_str), uuid_str);
107 }
108
109 if (pp->set & ENIC_SET_HOST) {
110 sprintf(uuid_str, "%pUB", pp->host_uuid);
111 VIC_PROVINFO_ADD_TLV(vp,
112 VIC_GENERIC_PROV_TLV_HOST_UUID_STR,
113 sizeof(uuid_str), uuid_str);
114 }
115
116 VIC_PROVINFO_ADD_TLV(vp,
117 VIC_GENERIC_PROV_TLV_OS_TYPE,
118 sizeof(os_type), &os_type);
119
120 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_init_prov2, (u8 *)vp,
121 vic_provinfo_size(vp));
122 err = enic_dev_status_to_errno(err);
123
124 add_tlv_failure:
125 vic_provinfo_free(vp);
126
127 return err;
128 }
129
enic_unset_port_profile(struct enic * enic,int vf)130 static int enic_unset_port_profile(struct enic *enic, int vf)
131 {
132 int err;
133
134 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_deinit);
135 if (err)
136 return enic_dev_status_to_errno(err);
137
138 if (vf == PORT_SELF_VF)
139 enic_reset_addr_lists(enic);
140
141 return 0;
142 }
143
enic_are_pp_different(struct enic_port_profile * pp1,struct enic_port_profile * pp2)144 static int enic_are_pp_different(struct enic_port_profile *pp1,
145 struct enic_port_profile *pp2)
146 {
147 return strcmp(pp1->name, pp2->name) | !!memcmp(pp1->instance_uuid,
148 pp2->instance_uuid, PORT_UUID_MAX) |
149 !!memcmp(pp1->host_uuid, pp2->host_uuid, PORT_UUID_MAX) |
150 !ether_addr_equal(pp1->mac_addr, pp2->mac_addr);
151 }
152
153 static int enic_pp_preassociate(struct enic *enic, int vf,
154 struct enic_port_profile *prev_pp, int *restore_pp);
155 static int enic_pp_disassociate(struct enic *enic, int vf,
156 struct enic_port_profile *prev_pp, int *restore_pp);
157 static int enic_pp_preassociate_rr(struct enic *enic, int vf,
158 struct enic_port_profile *prev_pp, int *restore_pp);
159 static int enic_pp_associate(struct enic *enic, int vf,
160 struct enic_port_profile *prev_pp, int *restore_pp);
161
162 static int (*enic_pp_handlers[])(struct enic *enic, int vf,
163 struct enic_port_profile *prev_state,
164 int *restore_pp) = {
165 [PORT_REQUEST_PREASSOCIATE] = enic_pp_preassociate,
166 [PORT_REQUEST_PREASSOCIATE_RR] = enic_pp_preassociate_rr,
167 [PORT_REQUEST_ASSOCIATE] = enic_pp_associate,
168 [PORT_REQUEST_DISASSOCIATE] = enic_pp_disassociate,
169 };
170
171 static const int enic_pp_handlers_count =
172 ARRAY_SIZE(enic_pp_handlers);
173
enic_pp_preassociate(struct enic * enic,int vf,struct enic_port_profile * prev_pp,int * restore_pp)174 static int enic_pp_preassociate(struct enic *enic, int vf,
175 struct enic_port_profile *prev_pp, int *restore_pp)
176 {
177 return -EOPNOTSUPP;
178 }
179
enic_pp_disassociate(struct enic * enic,int vf,struct enic_port_profile * prev_pp,int * restore_pp)180 static int enic_pp_disassociate(struct enic *enic, int vf,
181 struct enic_port_profile *prev_pp, int *restore_pp)
182 {
183 struct net_device *netdev = enic->netdev;
184 struct enic_port_profile *pp;
185 int err;
186
187 ENIC_PP_BY_INDEX(enic, vf, pp, &err);
188 if (err)
189 return err;
190
191 /* Deregister mac addresses */
192 if (!is_zero_ether_addr(pp->mac_addr))
193 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_del_addr,
194 pp->mac_addr);
195 else if (vf == PORT_SELF_VF && !is_zero_ether_addr(netdev->dev_addr))
196 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_del_addr,
197 netdev->dev_addr);
198
199 return enic_unset_port_profile(enic, vf);
200 }
201
enic_pp_preassociate_rr(struct enic * enic,int vf,struct enic_port_profile * prev_pp,int * restore_pp)202 static int enic_pp_preassociate_rr(struct enic *enic, int vf,
203 struct enic_port_profile *prev_pp, int *restore_pp)
204 {
205 struct enic_port_profile *pp;
206 int err;
207 int active = 0;
208
209 ENIC_PP_BY_INDEX(enic, vf, pp, &err);
210 if (err)
211 return err;
212
213 if (pp->request != PORT_REQUEST_ASSOCIATE) {
214 /* If pre-associate is not part of an associate.
215 We always disassociate first */
216 err = enic_pp_handlers[PORT_REQUEST_DISASSOCIATE](enic, vf,
217 prev_pp, restore_pp);
218 if (err)
219 return err;
220
221 *restore_pp = 0;
222 }
223
224 *restore_pp = 0;
225
226 err = enic_set_port_profile(enic, vf);
227 if (err)
228 return err;
229
230 /* If pre-associate is not part of an associate. */
231 if (pp->request != PORT_REQUEST_ASSOCIATE) {
232 /* Enable device as standby */
233 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_enable2,
234 active);
235 err = enic_dev_status_to_errno(err);
236 }
237
238 return err;
239 }
240
enic_pp_associate(struct enic * enic,int vf,struct enic_port_profile * prev_pp,int * restore_pp)241 static int enic_pp_associate(struct enic *enic, int vf,
242 struct enic_port_profile *prev_pp, int *restore_pp)
243 {
244 struct net_device *netdev = enic->netdev;
245 struct enic_port_profile *pp;
246 int err;
247 int active = 1;
248
249 ENIC_PP_BY_INDEX(enic, vf, pp, &err);
250 if (err)
251 return err;
252
253 /* Check if a pre-associate was called before */
254 if (prev_pp->request != PORT_REQUEST_PREASSOCIATE_RR ||
255 (prev_pp->request == PORT_REQUEST_PREASSOCIATE_RR &&
256 enic_are_pp_different(prev_pp, pp))) {
257 err = enic_pp_handlers[PORT_REQUEST_DISASSOCIATE](
258 enic, vf, prev_pp, restore_pp);
259 if (err)
260 return err;
261
262 *restore_pp = 0;
263 }
264
265 err = enic_pp_handlers[PORT_REQUEST_PREASSOCIATE_RR](
266 enic, vf, prev_pp, restore_pp);
267 if (err)
268 return err;
269
270 *restore_pp = 0;
271
272 /* Enable device as active */
273 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_enable2, active);
274 err = enic_dev_status_to_errno(err);
275 if (err)
276 return err;
277
278 /* Register mac address */
279 if (!is_zero_ether_addr(pp->mac_addr))
280 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_add_addr,
281 pp->mac_addr);
282 else if (vf == PORT_SELF_VF && !is_zero_ether_addr(netdev->dev_addr))
283 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic, vnic_dev_add_addr,
284 netdev->dev_addr);
285
286 return 0;
287 }
288
enic_process_set_pp_request(struct enic * enic,int vf,struct enic_port_profile * prev_pp,int * restore_pp)289 int enic_process_set_pp_request(struct enic *enic, int vf,
290 struct enic_port_profile *prev_pp, int *restore_pp)
291 {
292 struct enic_port_profile *pp;
293 int err;
294
295 ENIC_PP_BY_INDEX(enic, vf, pp, &err);
296 if (err)
297 return err;
298
299 if (pp->request >= enic_pp_handlers_count
300 || !enic_pp_handlers[pp->request])
301 return -EOPNOTSUPP;
302
303 return enic_pp_handlers[pp->request](enic, vf, prev_pp, restore_pp);
304 }
305
enic_process_get_pp_request(struct enic * enic,int vf,int request,u16 * response)306 int enic_process_get_pp_request(struct enic *enic, int vf,
307 int request, u16 *response)
308 {
309 int err, status = ERR_SUCCESS;
310
311 switch (request) {
312
313 case PORT_REQUEST_PREASSOCIATE_RR:
314 case PORT_REQUEST_ASSOCIATE:
315 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic,
316 vnic_dev_enable2_done, &status);
317 break;
318
319 case PORT_REQUEST_DISASSOCIATE:
320 ENIC_DEVCMD_PROXY_BY_INDEX(vf, err, enic,
321 vnic_dev_deinit_done, &status);
322 break;
323
324 default:
325 return -EINVAL;
326 }
327
328 if (err)
329 status = err;
330
331 switch (status) {
332 case ERR_SUCCESS:
333 *response = PORT_PROFILE_RESPONSE_SUCCESS;
334 break;
335 case ERR_EINVAL:
336 *response = PORT_PROFILE_RESPONSE_INVALID;
337 break;
338 case ERR_EBADSTATE:
339 *response = PORT_PROFILE_RESPONSE_BADSTATE;
340 break;
341 case ERR_ENOMEM:
342 *response = PORT_PROFILE_RESPONSE_INSUFFICIENT_RESOURCES;
343 break;
344 case ERR_EINPROGRESS:
345 *response = PORT_PROFILE_RESPONSE_INPROGRESS;
346 break;
347 default:
348 *response = PORT_PROFILE_RESPONSE_ERROR;
349 break;
350 }
351
352 return 0;
353 }
354