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  */
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 
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 
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 
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 
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 
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 
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 
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 
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 
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