xref: /openbmc/linux/drivers/net/team/team.c (revision 3ed71471)
13d249d4cSJiri Pirko /*
20d572e45SJiri Pirko  * drivers/net/team/team.c - Network team device driver
33d249d4cSJiri Pirko  * Copyright (c) 2011 Jiri Pirko <jpirko@redhat.com>
43d249d4cSJiri Pirko  *
53d249d4cSJiri Pirko  * This program is free software; you can redistribute it and/or modify
63d249d4cSJiri Pirko  * it under the terms of the GNU General Public License as published by
73d249d4cSJiri Pirko  * the Free Software Foundation; either version 2 of the License, or
83d249d4cSJiri Pirko  * (at your option) any later version.
93d249d4cSJiri Pirko  */
103d249d4cSJiri Pirko 
113d249d4cSJiri Pirko #include <linux/kernel.h>
123d249d4cSJiri Pirko #include <linux/types.h>
133d249d4cSJiri Pirko #include <linux/module.h>
143d249d4cSJiri Pirko #include <linux/init.h>
153d249d4cSJiri Pirko #include <linux/slab.h>
163d249d4cSJiri Pirko #include <linux/rcupdate.h>
173d249d4cSJiri Pirko #include <linux/errno.h>
183d249d4cSJiri Pirko #include <linux/ctype.h>
193d249d4cSJiri Pirko #include <linux/notifier.h>
203d249d4cSJiri Pirko #include <linux/netdevice.h>
21bd2d0837SJiri Pirko #include <linux/netpoll.h>
2287002b03SJiri Pirko #include <linux/if_vlan.h>
233d249d4cSJiri Pirko #include <linux/if_arp.h>
243d249d4cSJiri Pirko #include <linux/socket.h>
253d249d4cSJiri Pirko #include <linux/etherdevice.h>
263d249d4cSJiri Pirko #include <linux/rtnetlink.h>
273d249d4cSJiri Pirko #include <net/rtnetlink.h>
283d249d4cSJiri Pirko #include <net/genetlink.h>
293d249d4cSJiri Pirko #include <net/netlink.h>
306c85f2bdSJiri Pirko #include <net/sch_generic.h>
313d249d4cSJiri Pirko #include <linux/if_team.h>
323d249d4cSJiri Pirko 
333d249d4cSJiri Pirko #define DRV_NAME "team"
343d249d4cSJiri Pirko 
353d249d4cSJiri Pirko 
363d249d4cSJiri Pirko /**********
373d249d4cSJiri Pirko  * Helpers
383d249d4cSJiri Pirko  **********/
393d249d4cSJiri Pirko 
403d249d4cSJiri Pirko #define team_port_exists(dev) (dev->priv_flags & IFF_TEAM_PORT)
413d249d4cSJiri Pirko 
423d249d4cSJiri Pirko static struct team_port *team_port_get_rcu(const struct net_device *dev)
433d249d4cSJiri Pirko {
443d249d4cSJiri Pirko 	struct team_port *port = rcu_dereference(dev->rx_handler_data);
453d249d4cSJiri Pirko 
463d249d4cSJiri Pirko 	return team_port_exists(dev) ? port : NULL;
473d249d4cSJiri Pirko }
483d249d4cSJiri Pirko 
493d249d4cSJiri Pirko static struct team_port *team_port_get_rtnl(const struct net_device *dev)
503d249d4cSJiri Pirko {
513d249d4cSJiri Pirko 	struct team_port *port = rtnl_dereference(dev->rx_handler_data);
523d249d4cSJiri Pirko 
533d249d4cSJiri Pirko 	return team_port_exists(dev) ? port : NULL;
543d249d4cSJiri Pirko }
553d249d4cSJiri Pirko 
563d249d4cSJiri Pirko /*
571d76efe1SJiri Pirko  * Since the ability to change device address for open port device is tested in
583d249d4cSJiri Pirko  * team_port_add, this function can be called without control of return value
593d249d4cSJiri Pirko  */
601d76efe1SJiri Pirko static int __set_port_dev_addr(struct net_device *port_dev,
613d249d4cSJiri Pirko 			       const unsigned char *dev_addr)
623d249d4cSJiri Pirko {
633d249d4cSJiri Pirko 	struct sockaddr addr;
643d249d4cSJiri Pirko 
651d76efe1SJiri Pirko 	memcpy(addr.sa_data, dev_addr, port_dev->addr_len);
661d76efe1SJiri Pirko 	addr.sa_family = port_dev->type;
673d249d4cSJiri Pirko 	return dev_set_mac_address(port_dev, &addr);
683d249d4cSJiri Pirko }
693d249d4cSJiri Pirko 
701d76efe1SJiri Pirko static int team_port_set_orig_dev_addr(struct team_port *port)
713d249d4cSJiri Pirko {
721d76efe1SJiri Pirko 	return __set_port_dev_addr(port->dev, port->orig.dev_addr);
733d249d4cSJiri Pirko }
743d249d4cSJiri Pirko 
751d76efe1SJiri Pirko int team_port_set_team_dev_addr(struct team_port *port)
763d249d4cSJiri Pirko {
771d76efe1SJiri Pirko 	return __set_port_dev_addr(port->dev, port->team->dev->dev_addr);
783d249d4cSJiri Pirko }
791d76efe1SJiri Pirko EXPORT_SYMBOL(team_port_set_team_dev_addr);
803d249d4cSJiri Pirko 
8171472ec1SJiri Pirko static void team_refresh_port_linkup(struct team_port *port)
8271472ec1SJiri Pirko {
8371472ec1SJiri Pirko 	port->linkup = port->user.linkup_enabled ? port->user.linkup :
8471472ec1SJiri Pirko 						   port->state.linkup;
8571472ec1SJiri Pirko }
863d249d4cSJiri Pirko 
870f1aad2bSJiri Pirko 
883d249d4cSJiri Pirko /*******************
893d249d4cSJiri Pirko  * Options handling
903d249d4cSJiri Pirko  *******************/
913d249d4cSJiri Pirko 
9280f7c668SJiri Pirko struct team_option_inst { /* One for each option instance */
9380f7c668SJiri Pirko 	struct list_head list;
9401048d9aSJiri Pirko 	struct list_head tmp_list;
9580f7c668SJiri Pirko 	struct team_option *option;
9685d59a87SJiri Pirko 	struct team_option_inst_info info;
9780f7c668SJiri Pirko 	bool changed;
9880f7c668SJiri Pirko 	bool removed;
9980f7c668SJiri Pirko };
10080f7c668SJiri Pirko 
10180f7c668SJiri Pirko static struct team_option *__team_find_option(struct team *team,
10280f7c668SJiri Pirko 					      const char *opt_name)
103358b8382SJiri Pirko {
104358b8382SJiri Pirko 	struct team_option *option;
105358b8382SJiri Pirko 
106358b8382SJiri Pirko 	list_for_each_entry(option, &team->option_list, list) {
107358b8382SJiri Pirko 		if (strcmp(option->name, opt_name) == 0)
108358b8382SJiri Pirko 			return option;
109358b8382SJiri Pirko 	}
110358b8382SJiri Pirko 	return NULL;
111358b8382SJiri Pirko }
112358b8382SJiri Pirko 
11380f7c668SJiri Pirko static void __team_option_inst_del(struct team_option_inst *opt_inst)
11480f7c668SJiri Pirko {
11580f7c668SJiri Pirko 	list_del(&opt_inst->list);
11680f7c668SJiri Pirko 	kfree(opt_inst);
11780f7c668SJiri Pirko }
11880f7c668SJiri Pirko 
11980f7c668SJiri Pirko static void __team_option_inst_del_option(struct team *team,
12080f7c668SJiri Pirko 					  struct team_option *option)
12180f7c668SJiri Pirko {
12280f7c668SJiri Pirko 	struct team_option_inst *opt_inst, *tmp;
12380f7c668SJiri Pirko 
12480f7c668SJiri Pirko 	list_for_each_entry_safe(opt_inst, tmp, &team->option_inst_list, list) {
12580f7c668SJiri Pirko 		if (opt_inst->option == option)
12680f7c668SJiri Pirko 			__team_option_inst_del(opt_inst);
12780f7c668SJiri Pirko 	}
12880f7c668SJiri Pirko }
12980f7c668SJiri Pirko 
130b1303326SJiri Pirko static int __team_option_inst_add(struct team *team, struct team_option *option,
131b1303326SJiri Pirko 				  struct team_port *port)
132b1303326SJiri Pirko {
133b1303326SJiri Pirko 	struct team_option_inst *opt_inst;
134b1303326SJiri Pirko 	unsigned int array_size;
135b1303326SJiri Pirko 	unsigned int i;
13685d59a87SJiri Pirko 	int err;
137b1303326SJiri Pirko 
138b1303326SJiri Pirko 	array_size = option->array_size;
139b1303326SJiri Pirko 	if (!array_size)
140b1303326SJiri Pirko 		array_size = 1; /* No array but still need one instance */
141b1303326SJiri Pirko 
142b1303326SJiri Pirko 	for (i = 0; i < array_size; i++) {
143b1303326SJiri Pirko 		opt_inst = kmalloc(sizeof(*opt_inst), GFP_KERNEL);
144b1303326SJiri Pirko 		if (!opt_inst)
145b1303326SJiri Pirko 			return -ENOMEM;
146b1303326SJiri Pirko 		opt_inst->option = option;
14785d59a87SJiri Pirko 		opt_inst->info.port = port;
14885d59a87SJiri Pirko 		opt_inst->info.array_index = i;
149b1303326SJiri Pirko 		opt_inst->changed = true;
150b1303326SJiri Pirko 		opt_inst->removed = false;
151b1303326SJiri Pirko 		list_add_tail(&opt_inst->list, &team->option_inst_list);
15285d59a87SJiri Pirko 		if (option->init) {
15385d59a87SJiri Pirko 			err = option->init(team, &opt_inst->info);
15485d59a87SJiri Pirko 			if (err)
15585d59a87SJiri Pirko 				return err;
15685d59a87SJiri Pirko 		}
15785d59a87SJiri Pirko 
158b1303326SJiri Pirko 	}
159b1303326SJiri Pirko 	return 0;
160b1303326SJiri Pirko }
161b1303326SJiri Pirko 
16280f7c668SJiri Pirko static int __team_option_inst_add_option(struct team *team,
16380f7c668SJiri Pirko 					 struct team_option *option)
16480f7c668SJiri Pirko {
16580f7c668SJiri Pirko 	struct team_port *port;
16680f7c668SJiri Pirko 	int err;
16780f7c668SJiri Pirko 
168b1303326SJiri Pirko 	if (!option->per_port) {
169f88725ffSJiri Pirko 		err = __team_option_inst_add(team, option, NULL);
170b1303326SJiri Pirko 		if (err)
171b1303326SJiri Pirko 			goto inst_del_option;
172b1303326SJiri Pirko 	}
17380f7c668SJiri Pirko 
17480f7c668SJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
17580f7c668SJiri Pirko 		err = __team_option_inst_add(team, option, port);
17680f7c668SJiri Pirko 		if (err)
17780f7c668SJiri Pirko 			goto inst_del_option;
17880f7c668SJiri Pirko 	}
17980f7c668SJiri Pirko 	return 0;
18080f7c668SJiri Pirko 
18180f7c668SJiri Pirko inst_del_option:
18280f7c668SJiri Pirko 	__team_option_inst_del_option(team, option);
18380f7c668SJiri Pirko 	return err;
18480f7c668SJiri Pirko }
18580f7c668SJiri Pirko 
18680f7c668SJiri Pirko static void __team_option_inst_mark_removed_option(struct team *team,
18780f7c668SJiri Pirko 						   struct team_option *option)
18880f7c668SJiri Pirko {
18980f7c668SJiri Pirko 	struct team_option_inst *opt_inst;
19080f7c668SJiri Pirko 
19180f7c668SJiri Pirko 	list_for_each_entry(opt_inst, &team->option_inst_list, list) {
19280f7c668SJiri Pirko 		if (opt_inst->option == option) {
19380f7c668SJiri Pirko 			opt_inst->changed = true;
19480f7c668SJiri Pirko 			opt_inst->removed = true;
19580f7c668SJiri Pirko 		}
19680f7c668SJiri Pirko 	}
19780f7c668SJiri Pirko }
19880f7c668SJiri Pirko 
19980f7c668SJiri Pirko static void __team_option_inst_del_port(struct team *team,
20080f7c668SJiri Pirko 					struct team_port *port)
20180f7c668SJiri Pirko {
20280f7c668SJiri Pirko 	struct team_option_inst *opt_inst, *tmp;
20380f7c668SJiri Pirko 
20480f7c668SJiri Pirko 	list_for_each_entry_safe(opt_inst, tmp, &team->option_inst_list, list) {
20580f7c668SJiri Pirko 		if (opt_inst->option->per_port &&
20685d59a87SJiri Pirko 		    opt_inst->info.port == port)
20780f7c668SJiri Pirko 			__team_option_inst_del(opt_inst);
20880f7c668SJiri Pirko 	}
20980f7c668SJiri Pirko }
21080f7c668SJiri Pirko 
21180f7c668SJiri Pirko static int __team_option_inst_add_port(struct team *team,
21280f7c668SJiri Pirko 				       struct team_port *port)
21380f7c668SJiri Pirko {
21480f7c668SJiri Pirko 	struct team_option *option;
21580f7c668SJiri Pirko 	int err;
21680f7c668SJiri Pirko 
21780f7c668SJiri Pirko 	list_for_each_entry(option, &team->option_list, list) {
21880f7c668SJiri Pirko 		if (!option->per_port)
21980f7c668SJiri Pirko 			continue;
22080f7c668SJiri Pirko 		err = __team_option_inst_add(team, option, port);
22180f7c668SJiri Pirko 		if (err)
22280f7c668SJiri Pirko 			goto inst_del_port;
22380f7c668SJiri Pirko 	}
22480f7c668SJiri Pirko 	return 0;
22580f7c668SJiri Pirko 
22680f7c668SJiri Pirko inst_del_port:
22780f7c668SJiri Pirko 	__team_option_inst_del_port(team, port);
22880f7c668SJiri Pirko 	return err;
22980f7c668SJiri Pirko }
23080f7c668SJiri Pirko 
23180f7c668SJiri Pirko static void __team_option_inst_mark_removed_port(struct team *team,
23280f7c668SJiri Pirko 						 struct team_port *port)
23380f7c668SJiri Pirko {
23480f7c668SJiri Pirko 	struct team_option_inst *opt_inst;
23580f7c668SJiri Pirko 
23680f7c668SJiri Pirko 	list_for_each_entry(opt_inst, &team->option_inst_list, list) {
23785d59a87SJiri Pirko 		if (opt_inst->info.port == port) {
23880f7c668SJiri Pirko 			opt_inst->changed = true;
23980f7c668SJiri Pirko 			opt_inst->removed = true;
24080f7c668SJiri Pirko 		}
24180f7c668SJiri Pirko 	}
24280f7c668SJiri Pirko }
24380f7c668SJiri Pirko 
24480f7c668SJiri Pirko static int __team_options_register(struct team *team,
245358b8382SJiri Pirko 				   const struct team_option *option,
2463d249d4cSJiri Pirko 				   size_t option_count)
2473d249d4cSJiri Pirko {
2483d249d4cSJiri Pirko 	int i;
2492bba19ffSJiri Pirko 	struct team_option **dst_opts;
250358b8382SJiri Pirko 	int err;
2513d249d4cSJiri Pirko 
2522bba19ffSJiri Pirko 	dst_opts = kzalloc(sizeof(struct team_option *) * option_count,
2532bba19ffSJiri Pirko 			   GFP_KERNEL);
2542bba19ffSJiri Pirko 	if (!dst_opts)
2552bba19ffSJiri Pirko 		return -ENOMEM;
256358b8382SJiri Pirko 	for (i = 0; i < option_count; i++, option++) {
257358b8382SJiri Pirko 		if (__team_find_option(team, option->name)) {
258358b8382SJiri Pirko 			err = -EEXIST;
25980f7c668SJiri Pirko 			goto alloc_rollback;
2603d249d4cSJiri Pirko 		}
261f8a15af0SJiri Pirko 		dst_opts[i] = kmemdup(option, sizeof(*option), GFP_KERNEL);
262f8a15af0SJiri Pirko 		if (!dst_opts[i]) {
263358b8382SJiri Pirko 			err = -ENOMEM;
26480f7c668SJiri Pirko 			goto alloc_rollback;
265358b8382SJiri Pirko 		}
266358b8382SJiri Pirko 	}
267358b8382SJiri Pirko 
268b82b9183SJiri Pirko 	for (i = 0; i < option_count; i++) {
26980f7c668SJiri Pirko 		err = __team_option_inst_add_option(team, dst_opts[i]);
27080f7c668SJiri Pirko 		if (err)
27180f7c668SJiri Pirko 			goto inst_rollback;
272358b8382SJiri Pirko 		list_add_tail(&dst_opts[i]->list, &team->option_list);
273b82b9183SJiri Pirko 	}
274358b8382SJiri Pirko 
2752bba19ffSJiri Pirko 	kfree(dst_opts);
276358b8382SJiri Pirko 	return 0;
277358b8382SJiri Pirko 
27880f7c668SJiri Pirko inst_rollback:
27980f7c668SJiri Pirko 	for (i--; i >= 0; i--)
28080f7c668SJiri Pirko 		__team_option_inst_del_option(team, dst_opts[i]);
28180f7c668SJiri Pirko 
28280f7c668SJiri Pirko 	i = option_count - 1;
28380f7c668SJiri Pirko alloc_rollback:
28480f7c668SJiri Pirko 	for (i--; i >= 0; i--)
285358b8382SJiri Pirko 		kfree(dst_opts[i]);
286358b8382SJiri Pirko 
2872bba19ffSJiri Pirko 	kfree(dst_opts);
288358b8382SJiri Pirko 	return err;
289358b8382SJiri Pirko }
290358b8382SJiri Pirko 
291b82b9183SJiri Pirko static void __team_options_mark_removed(struct team *team,
292b82b9183SJiri Pirko 					const struct team_option *option,
293b82b9183SJiri Pirko 					size_t option_count)
294b82b9183SJiri Pirko {
295b82b9183SJiri Pirko 	int i;
2963d249d4cSJiri Pirko 
297b82b9183SJiri Pirko 	for (i = 0; i < option_count; i++, option++) {
298b82b9183SJiri Pirko 		struct team_option *del_opt;
299b82b9183SJiri Pirko 
300b82b9183SJiri Pirko 		del_opt = __team_find_option(team, option->name);
30180f7c668SJiri Pirko 		if (del_opt)
30280f7c668SJiri Pirko 			__team_option_inst_mark_removed_option(team, del_opt);
303b82b9183SJiri Pirko 	}
304b82b9183SJiri Pirko }
3053d249d4cSJiri Pirko 
3063d249d4cSJiri Pirko static void __team_options_unregister(struct team *team,
307358b8382SJiri Pirko 				      const struct team_option *option,
3083d249d4cSJiri Pirko 				      size_t option_count)
3093d249d4cSJiri Pirko {
3103d249d4cSJiri Pirko 	int i;
3113d249d4cSJiri Pirko 
312358b8382SJiri Pirko 	for (i = 0; i < option_count; i++, option++) {
313358b8382SJiri Pirko 		struct team_option *del_opt;
314358b8382SJiri Pirko 
315358b8382SJiri Pirko 		del_opt = __team_find_option(team, option->name);
316358b8382SJiri Pirko 		if (del_opt) {
31780f7c668SJiri Pirko 			__team_option_inst_del_option(team, del_opt);
318358b8382SJiri Pirko 			list_del(&del_opt->list);
319358b8382SJiri Pirko 			kfree(del_opt);
320358b8382SJiri Pirko 		}
321358b8382SJiri Pirko 	}
3223d249d4cSJiri Pirko }
3233d249d4cSJiri Pirko 
324b82b9183SJiri Pirko static void __team_options_change_check(struct team *team);
325b82b9183SJiri Pirko 
326b82b9183SJiri Pirko int team_options_register(struct team *team,
327b82b9183SJiri Pirko 			  const struct team_option *option,
328b82b9183SJiri Pirko 			  size_t option_count)
329b82b9183SJiri Pirko {
330b82b9183SJiri Pirko 	int err;
331b82b9183SJiri Pirko 
332b82b9183SJiri Pirko 	err = __team_options_register(team, option, option_count);
333b82b9183SJiri Pirko 	if (err)
334b82b9183SJiri Pirko 		return err;
335b82b9183SJiri Pirko 	__team_options_change_check(team);
336b82b9183SJiri Pirko 	return 0;
337b82b9183SJiri Pirko }
338b82b9183SJiri Pirko EXPORT_SYMBOL(team_options_register);
339b82b9183SJiri Pirko 
340358b8382SJiri Pirko void team_options_unregister(struct team *team,
341358b8382SJiri Pirko 			     const struct team_option *option,
3423d249d4cSJiri Pirko 			     size_t option_count)
3433d249d4cSJiri Pirko {
344b82b9183SJiri Pirko 	__team_options_mark_removed(team, option, option_count);
345b82b9183SJiri Pirko 	__team_options_change_check(team);
3463d249d4cSJiri Pirko 	__team_options_unregister(team, option, option_count);
3473d249d4cSJiri Pirko }
3483d249d4cSJiri Pirko EXPORT_SYMBOL(team_options_unregister);
3493d249d4cSJiri Pirko 
35080f7c668SJiri Pirko static int team_option_get(struct team *team,
35180f7c668SJiri Pirko 			   struct team_option_inst *opt_inst,
35280f7c668SJiri Pirko 			   struct team_gsetter_ctx *ctx)
35380f7c668SJiri Pirko {
354f82b959dSJiri Pirko 	if (!opt_inst->option->getter)
355f82b959dSJiri Pirko 		return -EOPNOTSUPP;
35680f7c668SJiri Pirko 	return opt_inst->option->getter(team, ctx);
35780f7c668SJiri Pirko }
35880f7c668SJiri Pirko 
35980f7c668SJiri Pirko static int team_option_set(struct team *team,
36080f7c668SJiri Pirko 			   struct team_option_inst *opt_inst,
36180f7c668SJiri Pirko 			   struct team_gsetter_ctx *ctx)
36280f7c668SJiri Pirko {
363f82b959dSJiri Pirko 	if (!opt_inst->option->setter)
364f82b959dSJiri Pirko 		return -EOPNOTSUPP;
3652fcdb2c9SJiri Pirko 	return opt_inst->option->setter(team, ctx);
3663d249d4cSJiri Pirko }
3673d249d4cSJiri Pirko 
3680f1aad2bSJiri Pirko void team_option_inst_set_change(struct team_option_inst_info *opt_inst_info)
3690f1aad2bSJiri Pirko {
3700f1aad2bSJiri Pirko 	struct team_option_inst *opt_inst;
3710f1aad2bSJiri Pirko 
3720f1aad2bSJiri Pirko 	opt_inst = container_of(opt_inst_info, struct team_option_inst, info);
3730f1aad2bSJiri Pirko 	opt_inst->changed = true;
3740f1aad2bSJiri Pirko }
3750f1aad2bSJiri Pirko EXPORT_SYMBOL(team_option_inst_set_change);
3760f1aad2bSJiri Pirko 
3770f1aad2bSJiri Pirko void team_options_change_check(struct team *team)
3780f1aad2bSJiri Pirko {
3790f1aad2bSJiri Pirko 	__team_options_change_check(team);
3800f1aad2bSJiri Pirko }
3810f1aad2bSJiri Pirko EXPORT_SYMBOL(team_options_change_check);
3820f1aad2bSJiri Pirko 
3830f1aad2bSJiri Pirko 
3843d249d4cSJiri Pirko /****************
3853d249d4cSJiri Pirko  * Mode handling
3863d249d4cSJiri Pirko  ****************/
3873d249d4cSJiri Pirko 
3883d249d4cSJiri Pirko static LIST_HEAD(mode_list);
3893d249d4cSJiri Pirko static DEFINE_SPINLOCK(mode_list_lock);
3903d249d4cSJiri Pirko 
3910402788aSJiri Pirko struct team_mode_item {
3920402788aSJiri Pirko 	struct list_head list;
3930402788aSJiri Pirko 	const struct team_mode *mode;
3940402788aSJiri Pirko };
3953d249d4cSJiri Pirko 
3960402788aSJiri Pirko static struct team_mode_item *__find_mode(const char *kind)
3970402788aSJiri Pirko {
3980402788aSJiri Pirko 	struct team_mode_item *mitem;
3990402788aSJiri Pirko 
4000402788aSJiri Pirko 	list_for_each_entry(mitem, &mode_list, list) {
4010402788aSJiri Pirko 		if (strcmp(mitem->mode->kind, kind) == 0)
4020402788aSJiri Pirko 			return mitem;
4033d249d4cSJiri Pirko 	}
4043d249d4cSJiri Pirko 	return NULL;
4053d249d4cSJiri Pirko }
4063d249d4cSJiri Pirko 
4073d249d4cSJiri Pirko static bool is_good_mode_name(const char *name)
4083d249d4cSJiri Pirko {
4093d249d4cSJiri Pirko 	while (*name != '\0') {
4103d249d4cSJiri Pirko 		if (!isalpha(*name) && !isdigit(*name) && *name != '_')
4113d249d4cSJiri Pirko 			return false;
4123d249d4cSJiri Pirko 		name++;
4133d249d4cSJiri Pirko 	}
4143d249d4cSJiri Pirko 	return true;
4153d249d4cSJiri Pirko }
4163d249d4cSJiri Pirko 
4170402788aSJiri Pirko int team_mode_register(const struct team_mode *mode)
4183d249d4cSJiri Pirko {
4193d249d4cSJiri Pirko 	int err = 0;
4200402788aSJiri Pirko 	struct team_mode_item *mitem;
4213d249d4cSJiri Pirko 
4223d249d4cSJiri Pirko 	if (!is_good_mode_name(mode->kind) ||
4233d249d4cSJiri Pirko 	    mode->priv_size > TEAM_MODE_PRIV_SIZE)
4243d249d4cSJiri Pirko 		return -EINVAL;
4250402788aSJiri Pirko 
4260402788aSJiri Pirko 	mitem = kmalloc(sizeof(*mitem), GFP_KERNEL);
4270402788aSJiri Pirko 	if (!mitem)
4280402788aSJiri Pirko 		return -ENOMEM;
4290402788aSJiri Pirko 
4303d249d4cSJiri Pirko 	spin_lock(&mode_list_lock);
4313d249d4cSJiri Pirko 	if (__find_mode(mode->kind)) {
4323d249d4cSJiri Pirko 		err = -EEXIST;
4330402788aSJiri Pirko 		kfree(mitem);
4343d249d4cSJiri Pirko 		goto unlock;
4353d249d4cSJiri Pirko 	}
4360402788aSJiri Pirko 	mitem->mode = mode;
4370402788aSJiri Pirko 	list_add_tail(&mitem->list, &mode_list);
4383d249d4cSJiri Pirko unlock:
4393d249d4cSJiri Pirko 	spin_unlock(&mode_list_lock);
4403d249d4cSJiri Pirko 	return err;
4413d249d4cSJiri Pirko }
4423d249d4cSJiri Pirko EXPORT_SYMBOL(team_mode_register);
4433d249d4cSJiri Pirko 
4440402788aSJiri Pirko void team_mode_unregister(const struct team_mode *mode)
4453d249d4cSJiri Pirko {
4460402788aSJiri Pirko 	struct team_mode_item *mitem;
4470402788aSJiri Pirko 
4483d249d4cSJiri Pirko 	spin_lock(&mode_list_lock);
4490402788aSJiri Pirko 	mitem = __find_mode(mode->kind);
4500402788aSJiri Pirko 	if (mitem) {
4510402788aSJiri Pirko 		list_del_init(&mitem->list);
4520402788aSJiri Pirko 		kfree(mitem);
4530402788aSJiri Pirko 	}
4543d249d4cSJiri Pirko 	spin_unlock(&mode_list_lock);
4553d249d4cSJiri Pirko }
4563d249d4cSJiri Pirko EXPORT_SYMBOL(team_mode_unregister);
4573d249d4cSJiri Pirko 
4580402788aSJiri Pirko static const struct team_mode *team_mode_get(const char *kind)
4593d249d4cSJiri Pirko {
4600402788aSJiri Pirko 	struct team_mode_item *mitem;
4610402788aSJiri Pirko 	const struct team_mode *mode = NULL;
4623d249d4cSJiri Pirko 
4633d249d4cSJiri Pirko 	spin_lock(&mode_list_lock);
4640402788aSJiri Pirko 	mitem = __find_mode(kind);
4650402788aSJiri Pirko 	if (!mitem) {
4663d249d4cSJiri Pirko 		spin_unlock(&mode_list_lock);
4673d249d4cSJiri Pirko 		request_module("team-mode-%s", kind);
4683d249d4cSJiri Pirko 		spin_lock(&mode_list_lock);
4690402788aSJiri Pirko 		mitem = __find_mode(kind);
4703d249d4cSJiri Pirko 	}
4710402788aSJiri Pirko 	if (mitem) {
4720402788aSJiri Pirko 		mode = mitem->mode;
4733d249d4cSJiri Pirko 		if (!try_module_get(mode->owner))
4743d249d4cSJiri Pirko 			mode = NULL;
4750402788aSJiri Pirko 	}
4763d249d4cSJiri Pirko 
4773d249d4cSJiri Pirko 	spin_unlock(&mode_list_lock);
4783d249d4cSJiri Pirko 	return mode;
4793d249d4cSJiri Pirko }
4803d249d4cSJiri Pirko 
4813d249d4cSJiri Pirko static void team_mode_put(const struct team_mode *mode)
4823d249d4cSJiri Pirko {
4833d249d4cSJiri Pirko 	module_put(mode->owner);
4843d249d4cSJiri Pirko }
4853d249d4cSJiri Pirko 
4863d249d4cSJiri Pirko static bool team_dummy_transmit(struct team *team, struct sk_buff *skb)
4873d249d4cSJiri Pirko {
4883d249d4cSJiri Pirko 	dev_kfree_skb_any(skb);
4893d249d4cSJiri Pirko 	return false;
4903d249d4cSJiri Pirko }
4913d249d4cSJiri Pirko 
4923d249d4cSJiri Pirko rx_handler_result_t team_dummy_receive(struct team *team,
4933d249d4cSJiri Pirko 				       struct team_port *port,
4943d249d4cSJiri Pirko 				       struct sk_buff *skb)
4953d249d4cSJiri Pirko {
4963d249d4cSJiri Pirko 	return RX_HANDLER_ANOTHER;
4973d249d4cSJiri Pirko }
4983d249d4cSJiri Pirko 
499d299cd51SJiri Pirko static const struct team_mode __team_no_mode = {
500d299cd51SJiri Pirko 	.kind		= "*NOMODE*",
501d299cd51SJiri Pirko };
502d299cd51SJiri Pirko 
503d299cd51SJiri Pirko static bool team_is_mode_set(struct team *team)
504d299cd51SJiri Pirko {
505d299cd51SJiri Pirko 	return team->mode != &__team_no_mode;
506d299cd51SJiri Pirko }
507d299cd51SJiri Pirko 
508d299cd51SJiri Pirko static void team_set_no_mode(struct team *team)
509d299cd51SJiri Pirko {
510d299cd51SJiri Pirko 	team->mode = &__team_no_mode;
511d299cd51SJiri Pirko }
512d299cd51SJiri Pirko 
513122bb046SJiri Pirko static void __team_adjust_ops(struct team *team, int en_port_count)
5143d249d4cSJiri Pirko {
5153d249d4cSJiri Pirko 	/*
5163d249d4cSJiri Pirko 	 * To avoid checks in rx/tx skb paths, ensure here that non-null and
5173d249d4cSJiri Pirko 	 * correct ops are always set.
5183d249d4cSJiri Pirko 	 */
5193d249d4cSJiri Pirko 
520122bb046SJiri Pirko 	if (!en_port_count || !team_is_mode_set(team) ||
521122bb046SJiri Pirko 	    !team->mode->ops->transmit)
5223d249d4cSJiri Pirko 		team->ops.transmit = team_dummy_transmit;
5233d249d4cSJiri Pirko 	else
5243d249d4cSJiri Pirko 		team->ops.transmit = team->mode->ops->transmit;
5253d249d4cSJiri Pirko 
526122bb046SJiri Pirko 	if (!en_port_count || !team_is_mode_set(team) ||
527122bb046SJiri Pirko 	    !team->mode->ops->receive)
5283d249d4cSJiri Pirko 		team->ops.receive = team_dummy_receive;
5293d249d4cSJiri Pirko 	else
5303d249d4cSJiri Pirko 		team->ops.receive = team->mode->ops->receive;
5313d249d4cSJiri Pirko }
5323d249d4cSJiri Pirko 
533122bb046SJiri Pirko static void team_adjust_ops(struct team *team)
534122bb046SJiri Pirko {
535122bb046SJiri Pirko 	__team_adjust_ops(team, team->en_port_count);
536122bb046SJiri Pirko }
537122bb046SJiri Pirko 
5383d249d4cSJiri Pirko /*
5393d249d4cSJiri Pirko  * We can benefit from the fact that it's ensured no port is present
5403d249d4cSJiri Pirko  * at the time of mode change. Therefore no packets are in fly so there's no
5413d249d4cSJiri Pirko  * need to set mode operations in any special way.
5423d249d4cSJiri Pirko  */
5433d249d4cSJiri Pirko static int __team_change_mode(struct team *team,
5443d249d4cSJiri Pirko 			      const struct team_mode *new_mode)
5453d249d4cSJiri Pirko {
5463d249d4cSJiri Pirko 	/* Check if mode was previously set and do cleanup if so */
547d299cd51SJiri Pirko 	if (team_is_mode_set(team)) {
5483d249d4cSJiri Pirko 		void (*exit_op)(struct team *team) = team->ops.exit;
5493d249d4cSJiri Pirko 
5503d249d4cSJiri Pirko 		/* Clear ops area so no callback is called any longer */
5513d249d4cSJiri Pirko 		memset(&team->ops, 0, sizeof(struct team_mode_ops));
5523d249d4cSJiri Pirko 		team_adjust_ops(team);
5533d249d4cSJiri Pirko 
5543d249d4cSJiri Pirko 		if (exit_op)
5553d249d4cSJiri Pirko 			exit_op(team);
5563d249d4cSJiri Pirko 		team_mode_put(team->mode);
557d299cd51SJiri Pirko 		team_set_no_mode(team);
5583d249d4cSJiri Pirko 		/* zero private data area */
5593d249d4cSJiri Pirko 		memset(&team->mode_priv, 0,
5603d249d4cSJiri Pirko 		       sizeof(struct team) - offsetof(struct team, mode_priv));
5613d249d4cSJiri Pirko 	}
5623d249d4cSJiri Pirko 
5633d249d4cSJiri Pirko 	if (!new_mode)
5643d249d4cSJiri Pirko 		return 0;
5653d249d4cSJiri Pirko 
5663d249d4cSJiri Pirko 	if (new_mode->ops->init) {
5673d249d4cSJiri Pirko 		int err;
5683d249d4cSJiri Pirko 
5693d249d4cSJiri Pirko 		err = new_mode->ops->init(team);
5703d249d4cSJiri Pirko 		if (err)
5713d249d4cSJiri Pirko 			return err;
5723d249d4cSJiri Pirko 	}
5733d249d4cSJiri Pirko 
5743d249d4cSJiri Pirko 	team->mode = new_mode;
5753d249d4cSJiri Pirko 	memcpy(&team->ops, new_mode->ops, sizeof(struct team_mode_ops));
5763d249d4cSJiri Pirko 	team_adjust_ops(team);
5773d249d4cSJiri Pirko 
5783d249d4cSJiri Pirko 	return 0;
5793d249d4cSJiri Pirko }
5803d249d4cSJiri Pirko 
5813d249d4cSJiri Pirko static int team_change_mode(struct team *team, const char *kind)
5823d249d4cSJiri Pirko {
5830402788aSJiri Pirko 	const struct team_mode *new_mode;
5843d249d4cSJiri Pirko 	struct net_device *dev = team->dev;
5853d249d4cSJiri Pirko 	int err;
5863d249d4cSJiri Pirko 
5873d249d4cSJiri Pirko 	if (!list_empty(&team->port_list)) {
5883d249d4cSJiri Pirko 		netdev_err(dev, "No ports can be present during mode change\n");
5893d249d4cSJiri Pirko 		return -EBUSY;
5903d249d4cSJiri Pirko 	}
5913d249d4cSJiri Pirko 
592d299cd51SJiri Pirko 	if (team_is_mode_set(team) && strcmp(team->mode->kind, kind) == 0) {
5933d249d4cSJiri Pirko 		netdev_err(dev, "Unable to change to the same mode the team is in\n");
5943d249d4cSJiri Pirko 		return -EINVAL;
5953d249d4cSJiri Pirko 	}
5963d249d4cSJiri Pirko 
5973d249d4cSJiri Pirko 	new_mode = team_mode_get(kind);
5983d249d4cSJiri Pirko 	if (!new_mode) {
5993d249d4cSJiri Pirko 		netdev_err(dev, "Mode \"%s\" not found\n", kind);
6003d249d4cSJiri Pirko 		return -EINVAL;
6013d249d4cSJiri Pirko 	}
6023d249d4cSJiri Pirko 
6033d249d4cSJiri Pirko 	err = __team_change_mode(team, new_mode);
6043d249d4cSJiri Pirko 	if (err) {
6053d249d4cSJiri Pirko 		netdev_err(dev, "Failed to change to mode \"%s\"\n", kind);
6063d249d4cSJiri Pirko 		team_mode_put(new_mode);
6073d249d4cSJiri Pirko 		return err;
6083d249d4cSJiri Pirko 	}
6093d249d4cSJiri Pirko 
6103d249d4cSJiri Pirko 	netdev_info(dev, "Mode changed to \"%s\"\n", kind);
6113d249d4cSJiri Pirko 	return 0;
6123d249d4cSJiri Pirko }
6133d249d4cSJiri Pirko 
6143d249d4cSJiri Pirko 
6153d249d4cSJiri Pirko /************************
6163d249d4cSJiri Pirko  * Rx path frame handler
6173d249d4cSJiri Pirko  ************************/
6183d249d4cSJiri Pirko 
6193d249d4cSJiri Pirko /* note: already called with rcu_read_lock */
6203d249d4cSJiri Pirko static rx_handler_result_t team_handle_frame(struct sk_buff **pskb)
6213d249d4cSJiri Pirko {
6223d249d4cSJiri Pirko 	struct sk_buff *skb = *pskb;
6233d249d4cSJiri Pirko 	struct team_port *port;
6243d249d4cSJiri Pirko 	struct team *team;
6253d249d4cSJiri Pirko 	rx_handler_result_t res;
6263d249d4cSJiri Pirko 
6273d249d4cSJiri Pirko 	skb = skb_share_check(skb, GFP_ATOMIC);
6283d249d4cSJiri Pirko 	if (!skb)
6293d249d4cSJiri Pirko 		return RX_HANDLER_CONSUMED;
6303d249d4cSJiri Pirko 
6313d249d4cSJiri Pirko 	*pskb = skb;
6323d249d4cSJiri Pirko 
6333d249d4cSJiri Pirko 	port = team_port_get_rcu(skb->dev);
6343d249d4cSJiri Pirko 	team = port->team;
63519a0b58eSJiri Pirko 	if (!team_port_enabled(port)) {
63619a0b58eSJiri Pirko 		/* allow exact match delivery for disabled ports */
63719a0b58eSJiri Pirko 		res = RX_HANDLER_EXACT;
63819a0b58eSJiri Pirko 	} else {
6393d249d4cSJiri Pirko 		res = team->ops.receive(team, port, skb);
64019a0b58eSJiri Pirko 	}
6413d249d4cSJiri Pirko 	if (res == RX_HANDLER_ANOTHER) {
6423d249d4cSJiri Pirko 		struct team_pcpu_stats *pcpu_stats;
6433d249d4cSJiri Pirko 
6443d249d4cSJiri Pirko 		pcpu_stats = this_cpu_ptr(team->pcpu_stats);
6453d249d4cSJiri Pirko 		u64_stats_update_begin(&pcpu_stats->syncp);
6463d249d4cSJiri Pirko 		pcpu_stats->rx_packets++;
6473d249d4cSJiri Pirko 		pcpu_stats->rx_bytes += skb->len;
6483d249d4cSJiri Pirko 		if (skb->pkt_type == PACKET_MULTICAST)
6493d249d4cSJiri Pirko 			pcpu_stats->rx_multicast++;
6503d249d4cSJiri Pirko 		u64_stats_update_end(&pcpu_stats->syncp);
6513d249d4cSJiri Pirko 
6523d249d4cSJiri Pirko 		skb->dev = team->dev;
6533d249d4cSJiri Pirko 	} else {
6543d249d4cSJiri Pirko 		this_cpu_inc(team->pcpu_stats->rx_dropped);
6553d249d4cSJiri Pirko 	}
6563d249d4cSJiri Pirko 
6573d249d4cSJiri Pirko 	return res;
6583d249d4cSJiri Pirko }
6593d249d4cSJiri Pirko 
6603d249d4cSJiri Pirko 
6618ff5105aSJiri Pirko /*************************************
6628ff5105aSJiri Pirko  * Multiqueue Tx port select override
6638ff5105aSJiri Pirko  *************************************/
6648ff5105aSJiri Pirko 
6658ff5105aSJiri Pirko static int team_queue_override_init(struct team *team)
6668ff5105aSJiri Pirko {
6678ff5105aSJiri Pirko 	struct list_head *listarr;
6688ff5105aSJiri Pirko 	unsigned int queue_cnt = team->dev->num_tx_queues - 1;
6698ff5105aSJiri Pirko 	unsigned int i;
6708ff5105aSJiri Pirko 
6718ff5105aSJiri Pirko 	if (!queue_cnt)
6728ff5105aSJiri Pirko 		return 0;
6738ff5105aSJiri Pirko 	listarr = kmalloc(sizeof(struct list_head) * queue_cnt, GFP_KERNEL);
6748ff5105aSJiri Pirko 	if (!listarr)
6758ff5105aSJiri Pirko 		return -ENOMEM;
6768ff5105aSJiri Pirko 	team->qom_lists = listarr;
6778ff5105aSJiri Pirko 	for (i = 0; i < queue_cnt; i++)
6788ff5105aSJiri Pirko 		INIT_LIST_HEAD(listarr++);
6798ff5105aSJiri Pirko 	return 0;
6808ff5105aSJiri Pirko }
6818ff5105aSJiri Pirko 
6828ff5105aSJiri Pirko static void team_queue_override_fini(struct team *team)
6838ff5105aSJiri Pirko {
6848ff5105aSJiri Pirko 	kfree(team->qom_lists);
6858ff5105aSJiri Pirko }
6868ff5105aSJiri Pirko 
6878ff5105aSJiri Pirko static struct list_head *__team_get_qom_list(struct team *team, u16 queue_id)
6888ff5105aSJiri Pirko {
6898ff5105aSJiri Pirko 	return &team->qom_lists[queue_id - 1];
6908ff5105aSJiri Pirko }
6918ff5105aSJiri Pirko 
6928ff5105aSJiri Pirko /*
6938ff5105aSJiri Pirko  * note: already called with rcu_read_lock
6948ff5105aSJiri Pirko  */
6958ff5105aSJiri Pirko static bool team_queue_override_transmit(struct team *team, struct sk_buff *skb)
6968ff5105aSJiri Pirko {
6978ff5105aSJiri Pirko 	struct list_head *qom_list;
6988ff5105aSJiri Pirko 	struct team_port *port;
6998ff5105aSJiri Pirko 
7008ff5105aSJiri Pirko 	if (!team->queue_override_enabled || !skb->queue_mapping)
7018ff5105aSJiri Pirko 		return false;
7028ff5105aSJiri Pirko 	qom_list = __team_get_qom_list(team, skb->queue_mapping);
7038ff5105aSJiri Pirko 	list_for_each_entry_rcu(port, qom_list, qom_list) {
7048ff5105aSJiri Pirko 		if (!team_dev_queue_xmit(team, port, skb))
7058ff5105aSJiri Pirko 			return true;
7068ff5105aSJiri Pirko 	}
7078ff5105aSJiri Pirko 	return false;
7088ff5105aSJiri Pirko }
7098ff5105aSJiri Pirko 
7108ff5105aSJiri Pirko static void __team_queue_override_port_del(struct team *team,
7118ff5105aSJiri Pirko 					   struct team_port *port)
7128ff5105aSJiri Pirko {
7138ff5105aSJiri Pirko 	list_del_rcu(&port->qom_list);
7148ff5105aSJiri Pirko 	synchronize_rcu();
7158ff5105aSJiri Pirko 	INIT_LIST_HEAD(&port->qom_list);
7168ff5105aSJiri Pirko }
7178ff5105aSJiri Pirko 
7188ff5105aSJiri Pirko static bool team_queue_override_port_has_gt_prio_than(struct team_port *port,
7198ff5105aSJiri Pirko 						      struct team_port *cur)
7208ff5105aSJiri Pirko {
7218ff5105aSJiri Pirko 	if (port->priority < cur->priority)
7228ff5105aSJiri Pirko 		return true;
7238ff5105aSJiri Pirko 	if (port->priority > cur->priority)
7248ff5105aSJiri Pirko 		return false;
7258ff5105aSJiri Pirko 	if (port->index < cur->index)
7268ff5105aSJiri Pirko 		return true;
7278ff5105aSJiri Pirko 	return false;
7288ff5105aSJiri Pirko }
7298ff5105aSJiri Pirko 
7308ff5105aSJiri Pirko static void __team_queue_override_port_add(struct team *team,
7318ff5105aSJiri Pirko 					   struct team_port *port)
7328ff5105aSJiri Pirko {
7338ff5105aSJiri Pirko 	struct team_port *cur;
7348ff5105aSJiri Pirko 	struct list_head *qom_list;
7358ff5105aSJiri Pirko 	struct list_head *node;
7368ff5105aSJiri Pirko 
7378ff5105aSJiri Pirko 	if (!port->queue_id || !team_port_enabled(port))
7388ff5105aSJiri Pirko 		return;
7398ff5105aSJiri Pirko 
7408ff5105aSJiri Pirko 	qom_list = __team_get_qom_list(team, port->queue_id);
7418ff5105aSJiri Pirko 	node = qom_list;
7428ff5105aSJiri Pirko 	list_for_each_entry(cur, qom_list, qom_list) {
7438ff5105aSJiri Pirko 		if (team_queue_override_port_has_gt_prio_than(port, cur))
7448ff5105aSJiri Pirko 			break;
7458ff5105aSJiri Pirko 		node = &cur->qom_list;
7468ff5105aSJiri Pirko 	}
7478ff5105aSJiri Pirko 	list_add_tail_rcu(&port->qom_list, node);
7488ff5105aSJiri Pirko }
7498ff5105aSJiri Pirko 
7508ff5105aSJiri Pirko static void __team_queue_override_enabled_check(struct team *team)
7518ff5105aSJiri Pirko {
7528ff5105aSJiri Pirko 	struct team_port *port;
7538ff5105aSJiri Pirko 	bool enabled = false;
7548ff5105aSJiri Pirko 
7558ff5105aSJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
7568ff5105aSJiri Pirko 		if (!list_empty(&port->qom_list)) {
7578ff5105aSJiri Pirko 			enabled = true;
7588ff5105aSJiri Pirko 			break;
7598ff5105aSJiri Pirko 		}
7608ff5105aSJiri Pirko 	}
7618ff5105aSJiri Pirko 	if (enabled == team->queue_override_enabled)
7628ff5105aSJiri Pirko 		return;
7638ff5105aSJiri Pirko 	netdev_dbg(team->dev, "%s queue override\n",
7648ff5105aSJiri Pirko 		   enabled ? "Enabling" : "Disabling");
7658ff5105aSJiri Pirko 	team->queue_override_enabled = enabled;
7668ff5105aSJiri Pirko }
7678ff5105aSJiri Pirko 
7688ff5105aSJiri Pirko static void team_queue_override_port_refresh(struct team *team,
7698ff5105aSJiri Pirko 					     struct team_port *port)
7708ff5105aSJiri Pirko {
7718ff5105aSJiri Pirko 	__team_queue_override_port_del(team, port);
7728ff5105aSJiri Pirko 	__team_queue_override_port_add(team, port);
7738ff5105aSJiri Pirko 	__team_queue_override_enabled_check(team);
7748ff5105aSJiri Pirko }
7758ff5105aSJiri Pirko 
7768ff5105aSJiri Pirko 
7773d249d4cSJiri Pirko /****************
7783d249d4cSJiri Pirko  * Port handling
7793d249d4cSJiri Pirko  ****************/
7803d249d4cSJiri Pirko 
7813d249d4cSJiri Pirko static bool team_port_find(const struct team *team,
7823d249d4cSJiri Pirko 			   const struct team_port *port)
7833d249d4cSJiri Pirko {
7843d249d4cSJiri Pirko 	struct team_port *cur;
7853d249d4cSJiri Pirko 
7863d249d4cSJiri Pirko 	list_for_each_entry(cur, &team->port_list, list)
7873d249d4cSJiri Pirko 		if (cur == port)
7883d249d4cSJiri Pirko 			return true;
7893d249d4cSJiri Pirko 	return false;
7903d249d4cSJiri Pirko }
7913d249d4cSJiri Pirko 
7923d249d4cSJiri Pirko /*
79319a0b58eSJiri Pirko  * Enable/disable port by adding to enabled port hashlist and setting
79419a0b58eSJiri Pirko  * port->index (Might be racy so reader could see incorrect ifindex when
79519a0b58eSJiri Pirko  * processing a flying packet, but that is not a problem). Write guarded
79619a0b58eSJiri Pirko  * by team->lock.
7973d249d4cSJiri Pirko  */
79819a0b58eSJiri Pirko static void team_port_enable(struct team *team,
7993d249d4cSJiri Pirko 			     struct team_port *port)
8003d249d4cSJiri Pirko {
80119a0b58eSJiri Pirko 	if (team_port_enabled(port))
80219a0b58eSJiri Pirko 		return;
80319a0b58eSJiri Pirko 	port->index = team->en_port_count++;
8043d249d4cSJiri Pirko 	hlist_add_head_rcu(&port->hlist,
8053d249d4cSJiri Pirko 			   team_port_index_hash(team, port->index));
806122bb046SJiri Pirko 	team_adjust_ops(team);
8078ff5105aSJiri Pirko 	team_queue_override_port_refresh(team, port);
8084bccfd17SJiri Pirko 	if (team->ops.port_enabled)
8094bccfd17SJiri Pirko 		team->ops.port_enabled(team, port);
8103d249d4cSJiri Pirko }
8113d249d4cSJiri Pirko 
8123d249d4cSJiri Pirko static void __reconstruct_port_hlist(struct team *team, int rm_index)
8133d249d4cSJiri Pirko {
8143d249d4cSJiri Pirko 	int i;
8153d249d4cSJiri Pirko 	struct team_port *port;
8163d249d4cSJiri Pirko 
81719a0b58eSJiri Pirko 	for (i = rm_index + 1; i < team->en_port_count; i++) {
8183d249d4cSJiri Pirko 		port = team_get_port_by_index(team, i);
8193d249d4cSJiri Pirko 		hlist_del_rcu(&port->hlist);
8203d249d4cSJiri Pirko 		port->index--;
8213d249d4cSJiri Pirko 		hlist_add_head_rcu(&port->hlist,
8223d249d4cSJiri Pirko 				   team_port_index_hash(team, port->index));
8233d249d4cSJiri Pirko 	}
8243d249d4cSJiri Pirko }
8253d249d4cSJiri Pirko 
82619a0b58eSJiri Pirko static void team_port_disable(struct team *team,
8273d249d4cSJiri Pirko 			      struct team_port *port)
8283d249d4cSJiri Pirko {
82919a0b58eSJiri Pirko 	if (!team_port_enabled(port))
83019a0b58eSJiri Pirko 		return;
8314bccfd17SJiri Pirko 	if (team->ops.port_disabled)
8324bccfd17SJiri Pirko 		team->ops.port_disabled(team, port);
8333d249d4cSJiri Pirko 	hlist_del_rcu(&port->hlist);
834122bb046SJiri Pirko 	__reconstruct_port_hlist(team, port->index);
83519a0b58eSJiri Pirko 	port->index = -1;
8368ff5105aSJiri Pirko 	team_queue_override_port_refresh(team, port);
837122bb046SJiri Pirko 	__team_adjust_ops(team, team->en_port_count - 1);
838122bb046SJiri Pirko 	/*
839122bb046SJiri Pirko 	 * Wait until readers see adjusted ops. This ensures that
840122bb046SJiri Pirko 	 * readers never see team->en_port_count == 0
841122bb046SJiri Pirko 	 */
842122bb046SJiri Pirko 	synchronize_rcu();
843122bb046SJiri Pirko 	team->en_port_count--;
8443d249d4cSJiri Pirko }
8453d249d4cSJiri Pirko 
8463d249d4cSJiri Pirko #define TEAM_VLAN_FEATURES (NETIF_F_ALL_CSUM | NETIF_F_SG | \
8473d249d4cSJiri Pirko 			    NETIF_F_FRAGLIST | NETIF_F_ALL_TSO | \
8483d249d4cSJiri Pirko 			    NETIF_F_HIGHDMA | NETIF_F_LRO)
8493d249d4cSJiri Pirko 
8503d249d4cSJiri Pirko static void __team_compute_features(struct team *team)
8513d249d4cSJiri Pirko {
8523d249d4cSJiri Pirko 	struct team_port *port;
8533d249d4cSJiri Pirko 	u32 vlan_features = TEAM_VLAN_FEATURES;
8543d249d4cSJiri Pirko 	unsigned short max_hard_header_len = ETH_HLEN;
855dc905951SJiri Pirko 	unsigned int flags, dst_release_flag = IFF_XMIT_DST_RELEASE;
8563d249d4cSJiri Pirko 
8573d249d4cSJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
8583d249d4cSJiri Pirko 		vlan_features = netdev_increment_features(vlan_features,
8593d249d4cSJiri Pirko 					port->dev->vlan_features,
8603d249d4cSJiri Pirko 					TEAM_VLAN_FEATURES);
8613d249d4cSJiri Pirko 
862dc905951SJiri Pirko 		dst_release_flag &= port->dev->priv_flags;
8633d249d4cSJiri Pirko 		if (port->dev->hard_header_len > max_hard_header_len)
8643d249d4cSJiri Pirko 			max_hard_header_len = port->dev->hard_header_len;
8653d249d4cSJiri Pirko 	}
8663d249d4cSJiri Pirko 
8673d249d4cSJiri Pirko 	team->dev->vlan_features = vlan_features;
8683d249d4cSJiri Pirko 	team->dev->hard_header_len = max_hard_header_len;
8693d249d4cSJiri Pirko 
870dc905951SJiri Pirko 	flags = team->dev->priv_flags & ~IFF_XMIT_DST_RELEASE;
871dc905951SJiri Pirko 	team->dev->priv_flags = flags | dst_release_flag;
872dc905951SJiri Pirko 
8733d249d4cSJiri Pirko 	netdev_change_features(team->dev);
8743d249d4cSJiri Pirko }
8753d249d4cSJiri Pirko 
8763d249d4cSJiri Pirko static void team_compute_features(struct team *team)
8773d249d4cSJiri Pirko {
87861dc3461SJiri Pirko 	mutex_lock(&team->lock);
8793d249d4cSJiri Pirko 	__team_compute_features(team);
88061dc3461SJiri Pirko 	mutex_unlock(&team->lock);
8813d249d4cSJiri Pirko }
8823d249d4cSJiri Pirko 
8833d249d4cSJiri Pirko static int team_port_enter(struct team *team, struct team_port *port)
8843d249d4cSJiri Pirko {
8853d249d4cSJiri Pirko 	int err = 0;
8863d249d4cSJiri Pirko 
8873d249d4cSJiri Pirko 	dev_hold(team->dev);
8883d249d4cSJiri Pirko 	port->dev->priv_flags |= IFF_TEAM_PORT;
8893d249d4cSJiri Pirko 	if (team->ops.port_enter) {
8903d249d4cSJiri Pirko 		err = team->ops.port_enter(team, port);
8913d249d4cSJiri Pirko 		if (err) {
8923d249d4cSJiri Pirko 			netdev_err(team->dev, "Device %s failed to enter team mode\n",
8933d249d4cSJiri Pirko 				   port->dev->name);
8943d249d4cSJiri Pirko 			goto err_port_enter;
8953d249d4cSJiri Pirko 		}
8963d249d4cSJiri Pirko 	}
8973d249d4cSJiri Pirko 
8983d249d4cSJiri Pirko 	return 0;
8993d249d4cSJiri Pirko 
9003d249d4cSJiri Pirko err_port_enter:
9013d249d4cSJiri Pirko 	port->dev->priv_flags &= ~IFF_TEAM_PORT;
9023d249d4cSJiri Pirko 	dev_put(team->dev);
9033d249d4cSJiri Pirko 
9043d249d4cSJiri Pirko 	return err;
9053d249d4cSJiri Pirko }
9063d249d4cSJiri Pirko 
9073d249d4cSJiri Pirko static void team_port_leave(struct team *team, struct team_port *port)
9083d249d4cSJiri Pirko {
9093d249d4cSJiri Pirko 	if (team->ops.port_leave)
9103d249d4cSJiri Pirko 		team->ops.port_leave(team, port);
9113d249d4cSJiri Pirko 	port->dev->priv_flags &= ~IFF_TEAM_PORT;
9123d249d4cSJiri Pirko 	dev_put(team->dev);
9133d249d4cSJiri Pirko }
9143d249d4cSJiri Pirko 
915bd2d0837SJiri Pirko #ifdef CONFIG_NET_POLL_CONTROLLER
91647be03a2SAmerigo Wang static int team_port_enable_netpoll(struct team *team, struct team_port *port,
91747be03a2SAmerigo Wang 				    gfp_t gfp)
918bd2d0837SJiri Pirko {
919bd2d0837SJiri Pirko 	struct netpoll *np;
920bd2d0837SJiri Pirko 	int err;
921bd2d0837SJiri Pirko 
92247be03a2SAmerigo Wang 	np = kzalloc(sizeof(*np), gfp);
923bd2d0837SJiri Pirko 	if (!np)
924bd2d0837SJiri Pirko 		return -ENOMEM;
925bd2d0837SJiri Pirko 
92647be03a2SAmerigo Wang 	err = __netpoll_setup(np, port->dev, gfp);
927bd2d0837SJiri Pirko 	if (err) {
928bd2d0837SJiri Pirko 		kfree(np);
929bd2d0837SJiri Pirko 		return err;
930bd2d0837SJiri Pirko 	}
931bd2d0837SJiri Pirko 	port->np = np;
932bd2d0837SJiri Pirko 	return err;
933bd2d0837SJiri Pirko }
934bd2d0837SJiri Pirko 
935bd2d0837SJiri Pirko static void team_port_disable_netpoll(struct team_port *port)
936bd2d0837SJiri Pirko {
937bd2d0837SJiri Pirko 	struct netpoll *np = port->np;
938bd2d0837SJiri Pirko 
939bd2d0837SJiri Pirko 	if (!np)
940bd2d0837SJiri Pirko 		return;
941bd2d0837SJiri Pirko 	port->np = NULL;
942bd2d0837SJiri Pirko 
943bd2d0837SJiri Pirko 	/* Wait for transmitting packets to finish before freeing. */
944bd2d0837SJiri Pirko 	synchronize_rcu_bh();
945bd2d0837SJiri Pirko 	__netpoll_cleanup(np);
946bd2d0837SJiri Pirko 	kfree(np);
947bd2d0837SJiri Pirko }
948bd2d0837SJiri Pirko 
949bd2d0837SJiri Pirko static struct netpoll_info *team_netpoll_info(struct team *team)
950bd2d0837SJiri Pirko {
951bd2d0837SJiri Pirko 	return team->dev->npinfo;
952bd2d0837SJiri Pirko }
953bd2d0837SJiri Pirko 
954bd2d0837SJiri Pirko #else
95547be03a2SAmerigo Wang static int team_port_enable_netpoll(struct team *team, struct team_port *port,
95647be03a2SAmerigo Wang 				    gfp_t gfp)
957bd2d0837SJiri Pirko {
958bd2d0837SJiri Pirko 	return 0;
959bd2d0837SJiri Pirko }
960bd2d0837SJiri Pirko static void team_port_disable_netpoll(struct team_port *port)
961bd2d0837SJiri Pirko {
962bd2d0837SJiri Pirko }
963bd2d0837SJiri Pirko static struct netpoll_info *team_netpoll_info(struct team *team)
964bd2d0837SJiri Pirko {
965bd2d0837SJiri Pirko 	return NULL;
966bd2d0837SJiri Pirko }
967bd2d0837SJiri Pirko #endif
968bd2d0837SJiri Pirko 
96910f3f51dSJiri Pirko static void __team_port_change_port_added(struct team_port *port, bool linkup);
9701d76efe1SJiri Pirko static int team_dev_type_check_change(struct net_device *dev,
9711d76efe1SJiri Pirko 				      struct net_device *port_dev);
9723d249d4cSJiri Pirko 
9733d249d4cSJiri Pirko static int team_port_add(struct team *team, struct net_device *port_dev)
9743d249d4cSJiri Pirko {
9753d249d4cSJiri Pirko 	struct net_device *dev = team->dev;
9763d249d4cSJiri Pirko 	struct team_port *port;
9773d249d4cSJiri Pirko 	char *portname = port_dev->name;
9783d249d4cSJiri Pirko 	int err;
9793d249d4cSJiri Pirko 
9801d76efe1SJiri Pirko 	if (port_dev->flags & IFF_LOOPBACK) {
9811d76efe1SJiri Pirko 		netdev_err(dev, "Device %s is loopback device. Loopback devices can't be added as a team port\n",
9823d249d4cSJiri Pirko 			   portname);
9833d249d4cSJiri Pirko 		return -EINVAL;
9843d249d4cSJiri Pirko 	}
9853d249d4cSJiri Pirko 
9863d249d4cSJiri Pirko 	if (team_port_exists(port_dev)) {
9873d249d4cSJiri Pirko 		netdev_err(dev, "Device %s is already a port "
9883d249d4cSJiri Pirko 				"of a team device\n", portname);
9893d249d4cSJiri Pirko 		return -EBUSY;
9903d249d4cSJiri Pirko 	}
9913d249d4cSJiri Pirko 
9922c33bb37SJiri Pirko 	if (port_dev->features & NETIF_F_VLAN_CHALLENGED &&
9932c33bb37SJiri Pirko 	    vlan_uses_dev(dev)) {
9942c33bb37SJiri Pirko 		netdev_err(dev, "Device %s is VLAN challenged and team device has VLAN set up\n",
9952c33bb37SJiri Pirko 			   portname);
9962c33bb37SJiri Pirko 		return -EPERM;
9972c33bb37SJiri Pirko 	}
9982c33bb37SJiri Pirko 
9991d76efe1SJiri Pirko 	err = team_dev_type_check_change(dev, port_dev);
10001d76efe1SJiri Pirko 	if (err)
10011d76efe1SJiri Pirko 		return err;
10021d76efe1SJiri Pirko 
10033d249d4cSJiri Pirko 	if (port_dev->flags & IFF_UP) {
10043d249d4cSJiri Pirko 		netdev_err(dev, "Device %s is up. Set it down before adding it as a team port\n",
10053d249d4cSJiri Pirko 			   portname);
10063d249d4cSJiri Pirko 		return -EBUSY;
10073d249d4cSJiri Pirko 	}
10083d249d4cSJiri Pirko 
10095149ee58SJiri Pirko 	port = kzalloc(sizeof(struct team_port) + team->mode->port_priv_size,
10105149ee58SJiri Pirko 		       GFP_KERNEL);
10113d249d4cSJiri Pirko 	if (!port)
10123d249d4cSJiri Pirko 		return -ENOMEM;
10133d249d4cSJiri Pirko 
10143d249d4cSJiri Pirko 	port->dev = port_dev;
10153d249d4cSJiri Pirko 	port->team = team;
10168ff5105aSJiri Pirko 	INIT_LIST_HEAD(&port->qom_list);
10173d249d4cSJiri Pirko 
10183d249d4cSJiri Pirko 	port->orig.mtu = port_dev->mtu;
10193d249d4cSJiri Pirko 	err = dev_set_mtu(port_dev, dev->mtu);
10203d249d4cSJiri Pirko 	if (err) {
10213d249d4cSJiri Pirko 		netdev_dbg(dev, "Error %d calling dev_set_mtu\n", err);
10223d249d4cSJiri Pirko 		goto err_set_mtu;
10233d249d4cSJiri Pirko 	}
10243d249d4cSJiri Pirko 
10251d76efe1SJiri Pirko 	memcpy(port->orig.dev_addr, port_dev->dev_addr, port_dev->addr_len);
10263d249d4cSJiri Pirko 
10273d249d4cSJiri Pirko 	err = team_port_enter(team, port);
10283d249d4cSJiri Pirko 	if (err) {
10293d249d4cSJiri Pirko 		netdev_err(dev, "Device %s failed to enter team mode\n",
10303d249d4cSJiri Pirko 			   portname);
10313d249d4cSJiri Pirko 		goto err_port_enter;
10323d249d4cSJiri Pirko 	}
10333d249d4cSJiri Pirko 
10343d249d4cSJiri Pirko 	err = dev_open(port_dev);
10353d249d4cSJiri Pirko 	if (err) {
10363d249d4cSJiri Pirko 		netdev_dbg(dev, "Device %s opening failed\n",
10373d249d4cSJiri Pirko 			   portname);
10383d249d4cSJiri Pirko 		goto err_dev_open;
10393d249d4cSJiri Pirko 	}
10403d249d4cSJiri Pirko 
104157459185SJiri Pirko 	err = vlan_vids_add_by_dev(port_dev, dev);
104257459185SJiri Pirko 	if (err) {
104357459185SJiri Pirko 		netdev_err(dev, "Failed to add vlan ids to device %s\n",
104457459185SJiri Pirko 				portname);
104557459185SJiri Pirko 		goto err_vids_add;
104657459185SJiri Pirko 	}
104757459185SJiri Pirko 
1048bd2d0837SJiri Pirko 	if (team_netpoll_info(team)) {
104947be03a2SAmerigo Wang 		err = team_port_enable_netpoll(team, port, GFP_KERNEL);
1050bd2d0837SJiri Pirko 		if (err) {
1051bd2d0837SJiri Pirko 			netdev_err(dev, "Failed to enable netpoll on device %s\n",
1052bd2d0837SJiri Pirko 				   portname);
1053bd2d0837SJiri Pirko 			goto err_enable_netpoll;
1054bd2d0837SJiri Pirko 		}
1055bd2d0837SJiri Pirko 	}
1056bd2d0837SJiri Pirko 
10573d249d4cSJiri Pirko 	err = netdev_set_master(port_dev, dev);
10583d249d4cSJiri Pirko 	if (err) {
10593d249d4cSJiri Pirko 		netdev_err(dev, "Device %s failed to set master\n", portname);
10603d249d4cSJiri Pirko 		goto err_set_master;
10613d249d4cSJiri Pirko 	}
10623d249d4cSJiri Pirko 
10633d249d4cSJiri Pirko 	err = netdev_rx_handler_register(port_dev, team_handle_frame,
10643d249d4cSJiri Pirko 					 port);
10653d249d4cSJiri Pirko 	if (err) {
10663d249d4cSJiri Pirko 		netdev_err(dev, "Device %s failed to register rx_handler\n",
10673d249d4cSJiri Pirko 			   portname);
10683d249d4cSJiri Pirko 		goto err_handler_register;
10693d249d4cSJiri Pirko 	}
10703d249d4cSJiri Pirko 
107135b384bdSJiri Pirko 	err = __team_option_inst_add_port(team, port);
107280f7c668SJiri Pirko 	if (err) {
107380f7c668SJiri Pirko 		netdev_err(dev, "Device %s failed to add per-port options\n",
107480f7c668SJiri Pirko 			   portname);
107580f7c668SJiri Pirko 		goto err_option_port_add;
107680f7c668SJiri Pirko 	}
107780f7c668SJiri Pirko 
107819a0b58eSJiri Pirko 	port->index = -1;
107919a0b58eSJiri Pirko 	team_port_enable(team, port);
108019a0b58eSJiri Pirko 	list_add_tail_rcu(&port->list, &team->port_list);
10813d249d4cSJiri Pirko 	__team_compute_features(team);
108210f3f51dSJiri Pirko 	__team_port_change_port_added(port, !!netif_carrier_ok(port_dev));
108335b384bdSJiri Pirko 	__team_options_change_check(team);
10843d249d4cSJiri Pirko 
10853d249d4cSJiri Pirko 	netdev_info(dev, "Port device %s added\n", portname);
10863d249d4cSJiri Pirko 
10873d249d4cSJiri Pirko 	return 0;
10883d249d4cSJiri Pirko 
108980f7c668SJiri Pirko err_option_port_add:
109080f7c668SJiri Pirko 	netdev_rx_handler_unregister(port_dev);
109180f7c668SJiri Pirko 
10923d249d4cSJiri Pirko err_handler_register:
10933d249d4cSJiri Pirko 	netdev_set_master(port_dev, NULL);
10943d249d4cSJiri Pirko 
10953d249d4cSJiri Pirko err_set_master:
1096bd2d0837SJiri Pirko 	team_port_disable_netpoll(port);
1097bd2d0837SJiri Pirko 
1098bd2d0837SJiri Pirko err_enable_netpoll:
109957459185SJiri Pirko 	vlan_vids_del_by_dev(port_dev, dev);
110057459185SJiri Pirko 
110157459185SJiri Pirko err_vids_add:
11023d249d4cSJiri Pirko 	dev_close(port_dev);
11033d249d4cSJiri Pirko 
11043d249d4cSJiri Pirko err_dev_open:
11053d249d4cSJiri Pirko 	team_port_leave(team, port);
11061d76efe1SJiri Pirko 	team_port_set_orig_dev_addr(port);
11073d249d4cSJiri Pirko 
11083d249d4cSJiri Pirko err_port_enter:
11093d249d4cSJiri Pirko 	dev_set_mtu(port_dev, port->orig.mtu);
11103d249d4cSJiri Pirko 
11113d249d4cSJiri Pirko err_set_mtu:
11123d249d4cSJiri Pirko 	kfree(port);
11133d249d4cSJiri Pirko 
11143d249d4cSJiri Pirko 	return err;
11153d249d4cSJiri Pirko }
11163d249d4cSJiri Pirko 
111710f3f51dSJiri Pirko static void __team_port_change_port_removed(struct team_port *port);
111810f3f51dSJiri Pirko 
11193d249d4cSJiri Pirko static int team_port_del(struct team *team, struct net_device *port_dev)
11203d249d4cSJiri Pirko {
11213d249d4cSJiri Pirko 	struct net_device *dev = team->dev;
11223d249d4cSJiri Pirko 	struct team_port *port;
11233d249d4cSJiri Pirko 	char *portname = port_dev->name;
11243d249d4cSJiri Pirko 
11253d249d4cSJiri Pirko 	port = team_port_get_rtnl(port_dev);
11263d249d4cSJiri Pirko 	if (!port || !team_port_find(team, port)) {
11273d249d4cSJiri Pirko 		netdev_err(dev, "Device %s does not act as a port of this team\n",
11283d249d4cSJiri Pirko 			   portname);
11293d249d4cSJiri Pirko 		return -ENOENT;
11303d249d4cSJiri Pirko 	}
11313d249d4cSJiri Pirko 
113235b384bdSJiri Pirko 	__team_option_inst_mark_removed_port(team, port);
113335b384bdSJiri Pirko 	__team_options_change_check(team);
113435b384bdSJiri Pirko 	__team_option_inst_del_port(team, port);
113510f3f51dSJiri Pirko 	__team_port_change_port_removed(port);
113619a0b58eSJiri Pirko 	team_port_disable(team, port);
113719a0b58eSJiri Pirko 	list_del_rcu(&port->list);
11383d249d4cSJiri Pirko 	netdev_rx_handler_unregister(port_dev);
11393d249d4cSJiri Pirko 	netdev_set_master(port_dev, NULL);
1140bd2d0837SJiri Pirko 	team_port_disable_netpoll(port);
114157459185SJiri Pirko 	vlan_vids_del_by_dev(port_dev, dev);
11423d249d4cSJiri Pirko 	dev_close(port_dev);
11433d249d4cSJiri Pirko 	team_port_leave(team, port);
11441d76efe1SJiri Pirko 	team_port_set_orig_dev_addr(port);
11453d249d4cSJiri Pirko 	dev_set_mtu(port_dev, port->orig.mtu);
11463d249d4cSJiri Pirko 	synchronize_rcu();
11473d249d4cSJiri Pirko 	kfree(port);
11483d249d4cSJiri Pirko 	netdev_info(dev, "Port device %s removed\n", portname);
11493d249d4cSJiri Pirko 	__team_compute_features(team);
11503d249d4cSJiri Pirko 
11513d249d4cSJiri Pirko 	return 0;
11523d249d4cSJiri Pirko }
11533d249d4cSJiri Pirko 
11543d249d4cSJiri Pirko 
11553d249d4cSJiri Pirko /*****************
11563d249d4cSJiri Pirko  * Net device ops
11573d249d4cSJiri Pirko  *****************/
11583d249d4cSJiri Pirko 
115980f7c668SJiri Pirko static int team_mode_option_get(struct team *team, struct team_gsetter_ctx *ctx)
11603d249d4cSJiri Pirko {
1161d299cd51SJiri Pirko 	ctx->data.str_val = team->mode->kind;
11623d249d4cSJiri Pirko 	return 0;
11633d249d4cSJiri Pirko }
11643d249d4cSJiri Pirko 
116580f7c668SJiri Pirko static int team_mode_option_set(struct team *team, struct team_gsetter_ctx *ctx)
11663d249d4cSJiri Pirko {
116780f7c668SJiri Pirko 	return team_change_mode(team, ctx->data.str_val);
11683d249d4cSJiri Pirko }
11693d249d4cSJiri Pirko 
1170acd69962SJiri Pirko static int team_port_en_option_get(struct team *team,
1171acd69962SJiri Pirko 				   struct team_gsetter_ctx *ctx)
1172acd69962SJiri Pirko {
117385d59a87SJiri Pirko 	struct team_port *port = ctx->info->port;
117485d59a87SJiri Pirko 
117585d59a87SJiri Pirko 	ctx->data.bool_val = team_port_enabled(port);
1176acd69962SJiri Pirko 	return 0;
1177acd69962SJiri Pirko }
1178acd69962SJiri Pirko 
1179acd69962SJiri Pirko static int team_port_en_option_set(struct team *team,
1180acd69962SJiri Pirko 				   struct team_gsetter_ctx *ctx)
1181acd69962SJiri Pirko {
118285d59a87SJiri Pirko 	struct team_port *port = ctx->info->port;
118385d59a87SJiri Pirko 
1184acd69962SJiri Pirko 	if (ctx->data.bool_val)
118585d59a87SJiri Pirko 		team_port_enable(team, port);
1186acd69962SJiri Pirko 	else
118785d59a87SJiri Pirko 		team_port_disable(team, port);
1188acd69962SJiri Pirko 	return 0;
1189acd69962SJiri Pirko }
1190acd69962SJiri Pirko 
119171472ec1SJiri Pirko static int team_user_linkup_option_get(struct team *team,
119271472ec1SJiri Pirko 				       struct team_gsetter_ctx *ctx)
119371472ec1SJiri Pirko {
119485d59a87SJiri Pirko 	struct team_port *port = ctx->info->port;
119585d59a87SJiri Pirko 
119685d59a87SJiri Pirko 	ctx->data.bool_val = port->user.linkup;
119771472ec1SJiri Pirko 	return 0;
119871472ec1SJiri Pirko }
119971472ec1SJiri Pirko 
120071472ec1SJiri Pirko static int team_user_linkup_option_set(struct team *team,
120171472ec1SJiri Pirko 				       struct team_gsetter_ctx *ctx)
120271472ec1SJiri Pirko {
120385d59a87SJiri Pirko 	struct team_port *port = ctx->info->port;
120485d59a87SJiri Pirko 
120585d59a87SJiri Pirko 	port->user.linkup = ctx->data.bool_val;
120685d59a87SJiri Pirko 	team_refresh_port_linkup(port);
120771472ec1SJiri Pirko 	return 0;
120871472ec1SJiri Pirko }
120971472ec1SJiri Pirko 
121071472ec1SJiri Pirko static int team_user_linkup_en_option_get(struct team *team,
121171472ec1SJiri Pirko 					  struct team_gsetter_ctx *ctx)
121271472ec1SJiri Pirko {
121385d59a87SJiri Pirko 	struct team_port *port = ctx->info->port;
121471472ec1SJiri Pirko 
121571472ec1SJiri Pirko 	ctx->data.bool_val = port->user.linkup_enabled;
121671472ec1SJiri Pirko 	return 0;
121771472ec1SJiri Pirko }
121871472ec1SJiri Pirko 
121971472ec1SJiri Pirko static int team_user_linkup_en_option_set(struct team *team,
122071472ec1SJiri Pirko 					  struct team_gsetter_ctx *ctx)
122171472ec1SJiri Pirko {
122285d59a87SJiri Pirko 	struct team_port *port = ctx->info->port;
122371472ec1SJiri Pirko 
122471472ec1SJiri Pirko 	port->user.linkup_enabled = ctx->data.bool_val;
122585d59a87SJiri Pirko 	team_refresh_port_linkup(port);
122671472ec1SJiri Pirko 	return 0;
122771472ec1SJiri Pirko }
122871472ec1SJiri Pirko 
1229a86fc6b7SJiri Pirko static int team_priority_option_get(struct team *team,
1230a86fc6b7SJiri Pirko 				    struct team_gsetter_ctx *ctx)
1231a86fc6b7SJiri Pirko {
1232a86fc6b7SJiri Pirko 	struct team_port *port = ctx->info->port;
1233a86fc6b7SJiri Pirko 
1234a86fc6b7SJiri Pirko 	ctx->data.s32_val = port->priority;
1235a86fc6b7SJiri Pirko 	return 0;
1236a86fc6b7SJiri Pirko }
1237a86fc6b7SJiri Pirko 
1238a86fc6b7SJiri Pirko static int team_priority_option_set(struct team *team,
1239a86fc6b7SJiri Pirko 				    struct team_gsetter_ctx *ctx)
1240a86fc6b7SJiri Pirko {
1241a86fc6b7SJiri Pirko 	struct team_port *port = ctx->info->port;
1242a86fc6b7SJiri Pirko 
1243a86fc6b7SJiri Pirko 	port->priority = ctx->data.s32_val;
12448ff5105aSJiri Pirko 	team_queue_override_port_refresh(team, port);
1245a86fc6b7SJiri Pirko 	return 0;
1246a86fc6b7SJiri Pirko }
1247a86fc6b7SJiri Pirko 
12488ff5105aSJiri Pirko static int team_queue_id_option_get(struct team *team,
12498ff5105aSJiri Pirko 				    struct team_gsetter_ctx *ctx)
12508ff5105aSJiri Pirko {
12518ff5105aSJiri Pirko 	struct team_port *port = ctx->info->port;
12528ff5105aSJiri Pirko 
12538ff5105aSJiri Pirko 	ctx->data.u32_val = port->queue_id;
12548ff5105aSJiri Pirko 	return 0;
12558ff5105aSJiri Pirko }
12568ff5105aSJiri Pirko 
12578ff5105aSJiri Pirko static int team_queue_id_option_set(struct team *team,
12588ff5105aSJiri Pirko 				    struct team_gsetter_ctx *ctx)
12598ff5105aSJiri Pirko {
12608ff5105aSJiri Pirko 	struct team_port *port = ctx->info->port;
12618ff5105aSJiri Pirko 
12628ff5105aSJiri Pirko 	if (port->queue_id == ctx->data.u32_val)
12638ff5105aSJiri Pirko 		return 0;
12648ff5105aSJiri Pirko 	if (ctx->data.u32_val >= team->dev->real_num_tx_queues)
12658ff5105aSJiri Pirko 		return -EINVAL;
12668ff5105aSJiri Pirko 	port->queue_id = ctx->data.u32_val;
12678ff5105aSJiri Pirko 	team_queue_override_port_refresh(team, port);
12688ff5105aSJiri Pirko 	return 0;
12698ff5105aSJiri Pirko }
12708ff5105aSJiri Pirko 
12718ff5105aSJiri Pirko 
1272358b8382SJiri Pirko static const struct team_option team_options[] = {
12733d249d4cSJiri Pirko 	{
12743d249d4cSJiri Pirko 		.name = "mode",
12753d249d4cSJiri Pirko 		.type = TEAM_OPTION_TYPE_STRING,
12763d249d4cSJiri Pirko 		.getter = team_mode_option_get,
12773d249d4cSJiri Pirko 		.setter = team_mode_option_set,
12783d249d4cSJiri Pirko 	},
127971472ec1SJiri Pirko 	{
1280acd69962SJiri Pirko 		.name = "enabled",
1281acd69962SJiri Pirko 		.type = TEAM_OPTION_TYPE_BOOL,
1282acd69962SJiri Pirko 		.per_port = true,
1283acd69962SJiri Pirko 		.getter = team_port_en_option_get,
1284acd69962SJiri Pirko 		.setter = team_port_en_option_set,
1285acd69962SJiri Pirko 	},
1286acd69962SJiri Pirko 	{
128771472ec1SJiri Pirko 		.name = "user_linkup",
128871472ec1SJiri Pirko 		.type = TEAM_OPTION_TYPE_BOOL,
128971472ec1SJiri Pirko 		.per_port = true,
129071472ec1SJiri Pirko 		.getter = team_user_linkup_option_get,
129171472ec1SJiri Pirko 		.setter = team_user_linkup_option_set,
129271472ec1SJiri Pirko 	},
129371472ec1SJiri Pirko 	{
129471472ec1SJiri Pirko 		.name = "user_linkup_enabled",
129571472ec1SJiri Pirko 		.type = TEAM_OPTION_TYPE_BOOL,
129671472ec1SJiri Pirko 		.per_port = true,
129771472ec1SJiri Pirko 		.getter = team_user_linkup_en_option_get,
129871472ec1SJiri Pirko 		.setter = team_user_linkup_en_option_set,
129971472ec1SJiri Pirko 	},
1300a86fc6b7SJiri Pirko 	{
1301a86fc6b7SJiri Pirko 		.name = "priority",
1302a86fc6b7SJiri Pirko 		.type = TEAM_OPTION_TYPE_S32,
1303a86fc6b7SJiri Pirko 		.per_port = true,
1304a86fc6b7SJiri Pirko 		.getter = team_priority_option_get,
1305a86fc6b7SJiri Pirko 		.setter = team_priority_option_set,
1306a86fc6b7SJiri Pirko 	},
13078ff5105aSJiri Pirko 	{
13088ff5105aSJiri Pirko 		.name = "queue_id",
13098ff5105aSJiri Pirko 		.type = TEAM_OPTION_TYPE_U32,
13108ff5105aSJiri Pirko 		.per_port = true,
13118ff5105aSJiri Pirko 		.getter = team_queue_id_option_get,
13128ff5105aSJiri Pirko 		.setter = team_queue_id_option_set,
13138ff5105aSJiri Pirko 	},
13143d249d4cSJiri Pirko };
13153d249d4cSJiri Pirko 
13166c85f2bdSJiri Pirko static struct lock_class_key team_netdev_xmit_lock_key;
13176c85f2bdSJiri Pirko static struct lock_class_key team_netdev_addr_lock_key;
1318b3c581d5SEric Dumazet static struct lock_class_key team_tx_busylock_key;
13196c85f2bdSJiri Pirko 
13206c85f2bdSJiri Pirko static void team_set_lockdep_class_one(struct net_device *dev,
13216c85f2bdSJiri Pirko 				       struct netdev_queue *txq,
13226c85f2bdSJiri Pirko 				       void *unused)
13236c85f2bdSJiri Pirko {
13246c85f2bdSJiri Pirko 	lockdep_set_class(&txq->_xmit_lock, &team_netdev_xmit_lock_key);
13256c85f2bdSJiri Pirko }
13266c85f2bdSJiri Pirko 
13276c85f2bdSJiri Pirko static void team_set_lockdep_class(struct net_device *dev)
13286c85f2bdSJiri Pirko {
13296c85f2bdSJiri Pirko 	lockdep_set_class(&dev->addr_list_lock, &team_netdev_addr_lock_key);
13306c85f2bdSJiri Pirko 	netdev_for_each_tx_queue(dev, team_set_lockdep_class_one, NULL);
1331b3c581d5SEric Dumazet 	dev->qdisc_tx_busylock = &team_tx_busylock_key;
13326c85f2bdSJiri Pirko }
13336c85f2bdSJiri Pirko 
13343d249d4cSJiri Pirko static int team_init(struct net_device *dev)
13353d249d4cSJiri Pirko {
13363d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
13373d249d4cSJiri Pirko 	int i;
1338358b8382SJiri Pirko 	int err;
13393d249d4cSJiri Pirko 
13403d249d4cSJiri Pirko 	team->dev = dev;
134161dc3461SJiri Pirko 	mutex_init(&team->lock);
1342d299cd51SJiri Pirko 	team_set_no_mode(team);
13433d249d4cSJiri Pirko 
13443d249d4cSJiri Pirko 	team->pcpu_stats = alloc_percpu(struct team_pcpu_stats);
13453d249d4cSJiri Pirko 	if (!team->pcpu_stats)
13463d249d4cSJiri Pirko 		return -ENOMEM;
13473d249d4cSJiri Pirko 
13483d249d4cSJiri Pirko 	for (i = 0; i < TEAM_PORT_HASHENTRIES; i++)
134919a0b58eSJiri Pirko 		INIT_HLIST_HEAD(&team->en_port_hlist[i]);
13503d249d4cSJiri Pirko 	INIT_LIST_HEAD(&team->port_list);
13518ff5105aSJiri Pirko 	err = team_queue_override_init(team);
13528ff5105aSJiri Pirko 	if (err)
13538ff5105aSJiri Pirko 		goto err_team_queue_override_init;
13543d249d4cSJiri Pirko 
13553d249d4cSJiri Pirko 	team_adjust_ops(team);
13563d249d4cSJiri Pirko 
13573d249d4cSJiri Pirko 	INIT_LIST_HEAD(&team->option_list);
135880f7c668SJiri Pirko 	INIT_LIST_HEAD(&team->option_inst_list);
1359358b8382SJiri Pirko 	err = team_options_register(team, team_options, ARRAY_SIZE(team_options));
1360358b8382SJiri Pirko 	if (err)
1361358b8382SJiri Pirko 		goto err_options_register;
13623d249d4cSJiri Pirko 	netif_carrier_off(dev);
13633d249d4cSJiri Pirko 
13646c85f2bdSJiri Pirko 	team_set_lockdep_class(dev);
13656c85f2bdSJiri Pirko 
13663d249d4cSJiri Pirko 	return 0;
1367358b8382SJiri Pirko 
1368358b8382SJiri Pirko err_options_register:
13698ff5105aSJiri Pirko 	team_queue_override_fini(team);
13708ff5105aSJiri Pirko err_team_queue_override_init:
1371358b8382SJiri Pirko 	free_percpu(team->pcpu_stats);
1372358b8382SJiri Pirko 
1373358b8382SJiri Pirko 	return err;
13743d249d4cSJiri Pirko }
13753d249d4cSJiri Pirko 
13763d249d4cSJiri Pirko static void team_uninit(struct net_device *dev)
13773d249d4cSJiri Pirko {
13783d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
13793d249d4cSJiri Pirko 	struct team_port *port;
13803d249d4cSJiri Pirko 	struct team_port *tmp;
13813d249d4cSJiri Pirko 
138261dc3461SJiri Pirko 	mutex_lock(&team->lock);
13833d249d4cSJiri Pirko 	list_for_each_entry_safe(port, tmp, &team->port_list, list)
13843d249d4cSJiri Pirko 		team_port_del(team, port->dev);
13853d249d4cSJiri Pirko 
13863d249d4cSJiri Pirko 	__team_change_mode(team, NULL); /* cleanup */
13873d249d4cSJiri Pirko 	__team_options_unregister(team, team_options, ARRAY_SIZE(team_options));
13888ff5105aSJiri Pirko 	team_queue_override_fini(team);
138961dc3461SJiri Pirko 	mutex_unlock(&team->lock);
13903d249d4cSJiri Pirko }
13913d249d4cSJiri Pirko 
13923d249d4cSJiri Pirko static void team_destructor(struct net_device *dev)
13933d249d4cSJiri Pirko {
13943d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
13953d249d4cSJiri Pirko 
13963d249d4cSJiri Pirko 	free_percpu(team->pcpu_stats);
13973d249d4cSJiri Pirko 	free_netdev(dev);
13983d249d4cSJiri Pirko }
13993d249d4cSJiri Pirko 
14003d249d4cSJiri Pirko static int team_open(struct net_device *dev)
14013d249d4cSJiri Pirko {
14023d249d4cSJiri Pirko 	netif_carrier_on(dev);
14033d249d4cSJiri Pirko 	return 0;
14043d249d4cSJiri Pirko }
14053d249d4cSJiri Pirko 
14063d249d4cSJiri Pirko static int team_close(struct net_device *dev)
14073d249d4cSJiri Pirko {
14083d249d4cSJiri Pirko 	netif_carrier_off(dev);
14093d249d4cSJiri Pirko 	return 0;
14103d249d4cSJiri Pirko }
14113d249d4cSJiri Pirko 
14123d249d4cSJiri Pirko /*
14133d249d4cSJiri Pirko  * note: already called with rcu_read_lock
14143d249d4cSJiri Pirko  */
14153d249d4cSJiri Pirko static netdev_tx_t team_xmit(struct sk_buff *skb, struct net_device *dev)
14163d249d4cSJiri Pirko {
14173d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
14188ff5105aSJiri Pirko 	bool tx_success;
14193d249d4cSJiri Pirko 	unsigned int len = skb->len;
14203d249d4cSJiri Pirko 
14218ff5105aSJiri Pirko 	tx_success = team_queue_override_transmit(team, skb);
14228ff5105aSJiri Pirko 	if (!tx_success)
14233d249d4cSJiri Pirko 		tx_success = team->ops.transmit(team, skb);
14243d249d4cSJiri Pirko 	if (tx_success) {
14253d249d4cSJiri Pirko 		struct team_pcpu_stats *pcpu_stats;
14263d249d4cSJiri Pirko 
14273d249d4cSJiri Pirko 		pcpu_stats = this_cpu_ptr(team->pcpu_stats);
14283d249d4cSJiri Pirko 		u64_stats_update_begin(&pcpu_stats->syncp);
14293d249d4cSJiri Pirko 		pcpu_stats->tx_packets++;
14303d249d4cSJiri Pirko 		pcpu_stats->tx_bytes += len;
14313d249d4cSJiri Pirko 		u64_stats_update_end(&pcpu_stats->syncp);
14323d249d4cSJiri Pirko 	} else {
14333d249d4cSJiri Pirko 		this_cpu_inc(team->pcpu_stats->tx_dropped);
14343d249d4cSJiri Pirko 	}
14353d249d4cSJiri Pirko 
14363d249d4cSJiri Pirko 	return NETDEV_TX_OK;
14373d249d4cSJiri Pirko }
14383d249d4cSJiri Pirko 
14396c85f2bdSJiri Pirko static u16 team_select_queue(struct net_device *dev, struct sk_buff *skb)
14406c85f2bdSJiri Pirko {
14416c85f2bdSJiri Pirko 	/*
14426c85f2bdSJiri Pirko 	 * This helper function exists to help dev_pick_tx get the correct
14436c85f2bdSJiri Pirko 	 * destination queue.  Using a helper function skips a call to
14446c85f2bdSJiri Pirko 	 * skb_tx_hash and will put the skbs in the queue we expect on their
14456c85f2bdSJiri Pirko 	 * way down to the team driver.
14466c85f2bdSJiri Pirko 	 */
14476c85f2bdSJiri Pirko 	u16 txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) : 0;
14486c85f2bdSJiri Pirko 
14496c85f2bdSJiri Pirko 	/*
14506c85f2bdSJiri Pirko 	 * Save the original txq to restore before passing to the driver
14516c85f2bdSJiri Pirko 	 */
14526c85f2bdSJiri Pirko 	qdisc_skb_cb(skb)->slave_dev_queue_mapping = skb->queue_mapping;
14536c85f2bdSJiri Pirko 
14546c85f2bdSJiri Pirko 	if (unlikely(txq >= dev->real_num_tx_queues)) {
14556c85f2bdSJiri Pirko 		do {
14566c85f2bdSJiri Pirko 			txq -= dev->real_num_tx_queues;
14576c85f2bdSJiri Pirko 		} while (txq >= dev->real_num_tx_queues);
14586c85f2bdSJiri Pirko 	}
14596c85f2bdSJiri Pirko 	return txq;
14606c85f2bdSJiri Pirko }
14616c85f2bdSJiri Pirko 
14623d249d4cSJiri Pirko static void team_change_rx_flags(struct net_device *dev, int change)
14633d249d4cSJiri Pirko {
14643d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
14653d249d4cSJiri Pirko 	struct team_port *port;
14663d249d4cSJiri Pirko 	int inc;
14673d249d4cSJiri Pirko 
14683d249d4cSJiri Pirko 	rcu_read_lock();
14693d249d4cSJiri Pirko 	list_for_each_entry_rcu(port, &team->port_list, list) {
14703d249d4cSJiri Pirko 		if (change & IFF_PROMISC) {
14713d249d4cSJiri Pirko 			inc = dev->flags & IFF_PROMISC ? 1 : -1;
14723d249d4cSJiri Pirko 			dev_set_promiscuity(port->dev, inc);
14733d249d4cSJiri Pirko 		}
14743d249d4cSJiri Pirko 		if (change & IFF_ALLMULTI) {
14753d249d4cSJiri Pirko 			inc = dev->flags & IFF_ALLMULTI ? 1 : -1;
14763d249d4cSJiri Pirko 			dev_set_allmulti(port->dev, inc);
14773d249d4cSJiri Pirko 		}
14783d249d4cSJiri Pirko 	}
14793d249d4cSJiri Pirko 	rcu_read_unlock();
14803d249d4cSJiri Pirko }
14813d249d4cSJiri Pirko 
14823d249d4cSJiri Pirko static void team_set_rx_mode(struct net_device *dev)
14833d249d4cSJiri Pirko {
14843d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
14853d249d4cSJiri Pirko 	struct team_port *port;
14863d249d4cSJiri Pirko 
14873d249d4cSJiri Pirko 	rcu_read_lock();
14883d249d4cSJiri Pirko 	list_for_each_entry_rcu(port, &team->port_list, list) {
14893d249d4cSJiri Pirko 		dev_uc_sync(port->dev, dev);
14903d249d4cSJiri Pirko 		dev_mc_sync(port->dev, dev);
14913d249d4cSJiri Pirko 	}
14923d249d4cSJiri Pirko 	rcu_read_unlock();
14933d249d4cSJiri Pirko }
14943d249d4cSJiri Pirko 
14953d249d4cSJiri Pirko static int team_set_mac_address(struct net_device *dev, void *p)
14963d249d4cSJiri Pirko {
14971d76efe1SJiri Pirko 	struct sockaddr *addr = p;
14983d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
14993d249d4cSJiri Pirko 	struct team_port *port;
15003d249d4cSJiri Pirko 
15011d76efe1SJiri Pirko 	if (dev->type == ARPHRD_ETHER && !is_valid_ether_addr(addr->sa_data))
15021d76efe1SJiri Pirko 		return -EADDRNOTAVAIL;
15031d76efe1SJiri Pirko 	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
15041d76efe1SJiri Pirko 	dev->addr_assign_type &= ~NET_ADDR_RANDOM;
15053d249d4cSJiri Pirko 	rcu_read_lock();
15063d249d4cSJiri Pirko 	list_for_each_entry_rcu(port, &team->port_list, list)
15071d76efe1SJiri Pirko 		if (team->ops.port_change_dev_addr)
15081d76efe1SJiri Pirko 			team->ops.port_change_dev_addr(team, port);
15093d249d4cSJiri Pirko 	rcu_read_unlock();
15103d249d4cSJiri Pirko 	return 0;
15113d249d4cSJiri Pirko }
15123d249d4cSJiri Pirko 
15133d249d4cSJiri Pirko static int team_change_mtu(struct net_device *dev, int new_mtu)
15143d249d4cSJiri Pirko {
15153d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
15163d249d4cSJiri Pirko 	struct team_port *port;
15173d249d4cSJiri Pirko 	int err;
15183d249d4cSJiri Pirko 
15193d249d4cSJiri Pirko 	/*
15203d249d4cSJiri Pirko 	 * Alhough this is reader, it's guarded by team lock. It's not possible
15213d249d4cSJiri Pirko 	 * to traverse list in reverse under rcu_read_lock
15223d249d4cSJiri Pirko 	 */
152361dc3461SJiri Pirko 	mutex_lock(&team->lock);
15243d249d4cSJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
15253d249d4cSJiri Pirko 		err = dev_set_mtu(port->dev, new_mtu);
15263d249d4cSJiri Pirko 		if (err) {
15273d249d4cSJiri Pirko 			netdev_err(dev, "Device %s failed to change mtu",
15283d249d4cSJiri Pirko 				   port->dev->name);
15293d249d4cSJiri Pirko 			goto unwind;
15303d249d4cSJiri Pirko 		}
15313d249d4cSJiri Pirko 	}
153261dc3461SJiri Pirko 	mutex_unlock(&team->lock);
15333d249d4cSJiri Pirko 
15343d249d4cSJiri Pirko 	dev->mtu = new_mtu;
15353d249d4cSJiri Pirko 
15363d249d4cSJiri Pirko 	return 0;
15373d249d4cSJiri Pirko 
15383d249d4cSJiri Pirko unwind:
15393d249d4cSJiri Pirko 	list_for_each_entry_continue_reverse(port, &team->port_list, list)
15403d249d4cSJiri Pirko 		dev_set_mtu(port->dev, dev->mtu);
154161dc3461SJiri Pirko 	mutex_unlock(&team->lock);
15423d249d4cSJiri Pirko 
15433d249d4cSJiri Pirko 	return err;
15443d249d4cSJiri Pirko }
15453d249d4cSJiri Pirko 
15463d249d4cSJiri Pirko static struct rtnl_link_stats64 *
15473d249d4cSJiri Pirko team_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats)
15483d249d4cSJiri Pirko {
15493d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
15503d249d4cSJiri Pirko 	struct team_pcpu_stats *p;
15513d249d4cSJiri Pirko 	u64 rx_packets, rx_bytes, rx_multicast, tx_packets, tx_bytes;
15523d249d4cSJiri Pirko 	u32 rx_dropped = 0, tx_dropped = 0;
15533d249d4cSJiri Pirko 	unsigned int start;
15543d249d4cSJiri Pirko 	int i;
15553d249d4cSJiri Pirko 
15563d249d4cSJiri Pirko 	for_each_possible_cpu(i) {
15573d249d4cSJiri Pirko 		p = per_cpu_ptr(team->pcpu_stats, i);
15583d249d4cSJiri Pirko 		do {
15593d249d4cSJiri Pirko 			start = u64_stats_fetch_begin_bh(&p->syncp);
15603d249d4cSJiri Pirko 			rx_packets	= p->rx_packets;
15613d249d4cSJiri Pirko 			rx_bytes	= p->rx_bytes;
15623d249d4cSJiri Pirko 			rx_multicast	= p->rx_multicast;
15633d249d4cSJiri Pirko 			tx_packets	= p->tx_packets;
15643d249d4cSJiri Pirko 			tx_bytes	= p->tx_bytes;
15653d249d4cSJiri Pirko 		} while (u64_stats_fetch_retry_bh(&p->syncp, start));
15663d249d4cSJiri Pirko 
15673d249d4cSJiri Pirko 		stats->rx_packets	+= rx_packets;
15683d249d4cSJiri Pirko 		stats->rx_bytes		+= rx_bytes;
15693d249d4cSJiri Pirko 		stats->multicast	+= rx_multicast;
15703d249d4cSJiri Pirko 		stats->tx_packets	+= tx_packets;
15713d249d4cSJiri Pirko 		stats->tx_bytes		+= tx_bytes;
15723d249d4cSJiri Pirko 		/*
15733d249d4cSJiri Pirko 		 * rx_dropped & tx_dropped are u32, updated
15743d249d4cSJiri Pirko 		 * without syncp protection.
15753d249d4cSJiri Pirko 		 */
15763d249d4cSJiri Pirko 		rx_dropped	+= p->rx_dropped;
15773d249d4cSJiri Pirko 		tx_dropped	+= p->tx_dropped;
15783d249d4cSJiri Pirko 	}
15793d249d4cSJiri Pirko 	stats->rx_dropped	= rx_dropped;
15803d249d4cSJiri Pirko 	stats->tx_dropped	= tx_dropped;
15813d249d4cSJiri Pirko 	return stats;
15823d249d4cSJiri Pirko }
15833d249d4cSJiri Pirko 
15848e586137SJiri Pirko static int team_vlan_rx_add_vid(struct net_device *dev, uint16_t vid)
15853d249d4cSJiri Pirko {
15863d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
15873d249d4cSJiri Pirko 	struct team_port *port;
158887002b03SJiri Pirko 	int err;
15893d249d4cSJiri Pirko 
159087002b03SJiri Pirko 	/*
159187002b03SJiri Pirko 	 * Alhough this is reader, it's guarded by team lock. It's not possible
159287002b03SJiri Pirko 	 * to traverse list in reverse under rcu_read_lock
159387002b03SJiri Pirko 	 */
159487002b03SJiri Pirko 	mutex_lock(&team->lock);
159587002b03SJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
159687002b03SJiri Pirko 		err = vlan_vid_add(port->dev, vid);
159787002b03SJiri Pirko 		if (err)
159887002b03SJiri Pirko 			goto unwind;
15993d249d4cSJiri Pirko 	}
160087002b03SJiri Pirko 	mutex_unlock(&team->lock);
16018e586137SJiri Pirko 
16028e586137SJiri Pirko 	return 0;
160387002b03SJiri Pirko 
160487002b03SJiri Pirko unwind:
160587002b03SJiri Pirko 	list_for_each_entry_continue_reverse(port, &team->port_list, list)
160687002b03SJiri Pirko 		vlan_vid_del(port->dev, vid);
160787002b03SJiri Pirko 	mutex_unlock(&team->lock);
160887002b03SJiri Pirko 
160987002b03SJiri Pirko 	return err;
16103d249d4cSJiri Pirko }
16113d249d4cSJiri Pirko 
16128e586137SJiri Pirko static int team_vlan_rx_kill_vid(struct net_device *dev, uint16_t vid)
16133d249d4cSJiri Pirko {
16143d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
16153d249d4cSJiri Pirko 	struct team_port *port;
16163d249d4cSJiri Pirko 
16173d249d4cSJiri Pirko 	rcu_read_lock();
161887002b03SJiri Pirko 	list_for_each_entry_rcu(port, &team->port_list, list)
161987002b03SJiri Pirko 		vlan_vid_del(port->dev, vid);
16203d249d4cSJiri Pirko 	rcu_read_unlock();
16218e586137SJiri Pirko 
16228e586137SJiri Pirko 	return 0;
16233d249d4cSJiri Pirko }
16243d249d4cSJiri Pirko 
1625bd2d0837SJiri Pirko #ifdef CONFIG_NET_POLL_CONTROLLER
1626bd2d0837SJiri Pirko static void team_poll_controller(struct net_device *dev)
1627bd2d0837SJiri Pirko {
1628bd2d0837SJiri Pirko }
1629bd2d0837SJiri Pirko 
1630bd2d0837SJiri Pirko static void __team_netpoll_cleanup(struct team *team)
1631bd2d0837SJiri Pirko {
1632bd2d0837SJiri Pirko 	struct team_port *port;
1633bd2d0837SJiri Pirko 
1634bd2d0837SJiri Pirko 	list_for_each_entry(port, &team->port_list, list)
1635bd2d0837SJiri Pirko 		team_port_disable_netpoll(port);
1636bd2d0837SJiri Pirko }
1637bd2d0837SJiri Pirko 
1638bd2d0837SJiri Pirko static void team_netpoll_cleanup(struct net_device *dev)
1639bd2d0837SJiri Pirko {
1640bd2d0837SJiri Pirko 	struct team *team = netdev_priv(dev);
1641bd2d0837SJiri Pirko 
1642bd2d0837SJiri Pirko 	mutex_lock(&team->lock);
1643bd2d0837SJiri Pirko 	__team_netpoll_cleanup(team);
1644bd2d0837SJiri Pirko 	mutex_unlock(&team->lock);
1645bd2d0837SJiri Pirko }
1646bd2d0837SJiri Pirko 
1647bd2d0837SJiri Pirko static int team_netpoll_setup(struct net_device *dev,
164847be03a2SAmerigo Wang 			      struct netpoll_info *npifo, gfp_t gfp)
1649bd2d0837SJiri Pirko {
1650bd2d0837SJiri Pirko 	struct team *team = netdev_priv(dev);
1651bd2d0837SJiri Pirko 	struct team_port *port;
16523324d024SJiri Pirko 	int err = 0;
1653bd2d0837SJiri Pirko 
1654bd2d0837SJiri Pirko 	mutex_lock(&team->lock);
1655bd2d0837SJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
165647be03a2SAmerigo Wang 		err = team_port_enable_netpoll(team, port, gfp);
1657bd2d0837SJiri Pirko 		if (err) {
1658bd2d0837SJiri Pirko 			__team_netpoll_cleanup(team);
1659bd2d0837SJiri Pirko 			break;
1660bd2d0837SJiri Pirko 		}
1661bd2d0837SJiri Pirko 	}
1662bd2d0837SJiri Pirko 	mutex_unlock(&team->lock);
1663bd2d0837SJiri Pirko 	return err;
1664bd2d0837SJiri Pirko }
1665bd2d0837SJiri Pirko #endif
1666bd2d0837SJiri Pirko 
16673d249d4cSJiri Pirko static int team_add_slave(struct net_device *dev, struct net_device *port_dev)
16683d249d4cSJiri Pirko {
16693d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
16703d249d4cSJiri Pirko 	int err;
16713d249d4cSJiri Pirko 
167261dc3461SJiri Pirko 	mutex_lock(&team->lock);
16733d249d4cSJiri Pirko 	err = team_port_add(team, port_dev);
167461dc3461SJiri Pirko 	mutex_unlock(&team->lock);
16753d249d4cSJiri Pirko 	return err;
16763d249d4cSJiri Pirko }
16773d249d4cSJiri Pirko 
16783d249d4cSJiri Pirko static int team_del_slave(struct net_device *dev, struct net_device *port_dev)
16793d249d4cSJiri Pirko {
16803d249d4cSJiri Pirko 	struct team *team = netdev_priv(dev);
16813d249d4cSJiri Pirko 	int err;
16823d249d4cSJiri Pirko 
168361dc3461SJiri Pirko 	mutex_lock(&team->lock);
16843d249d4cSJiri Pirko 	err = team_port_del(team, port_dev);
168561dc3461SJiri Pirko 	mutex_unlock(&team->lock);
16863d249d4cSJiri Pirko 	return err;
16873d249d4cSJiri Pirko }
16883d249d4cSJiri Pirko 
1689234a8fd4SJiri Pirko static netdev_features_t team_fix_features(struct net_device *dev,
1690234a8fd4SJiri Pirko 					   netdev_features_t features)
1691234a8fd4SJiri Pirko {
1692234a8fd4SJiri Pirko 	struct team_port *port;
1693234a8fd4SJiri Pirko 	struct team *team = netdev_priv(dev);
1694234a8fd4SJiri Pirko 	netdev_features_t mask;
1695234a8fd4SJiri Pirko 
1696234a8fd4SJiri Pirko 	mask = features;
1697234a8fd4SJiri Pirko 	features &= ~NETIF_F_ONE_FOR_ALL;
1698234a8fd4SJiri Pirko 	features |= NETIF_F_ALL_FOR_ALL;
1699234a8fd4SJiri Pirko 
1700234a8fd4SJiri Pirko 	rcu_read_lock();
1701234a8fd4SJiri Pirko 	list_for_each_entry_rcu(port, &team->port_list, list) {
1702234a8fd4SJiri Pirko 		features = netdev_increment_features(features,
1703234a8fd4SJiri Pirko 						     port->dev->features,
1704234a8fd4SJiri Pirko 						     mask);
1705234a8fd4SJiri Pirko 	}
1706234a8fd4SJiri Pirko 	rcu_read_unlock();
1707234a8fd4SJiri Pirko 	return features;
1708234a8fd4SJiri Pirko }
1709234a8fd4SJiri Pirko 
17103d249d4cSJiri Pirko static const struct net_device_ops team_netdev_ops = {
17113d249d4cSJiri Pirko 	.ndo_init		= team_init,
17123d249d4cSJiri Pirko 	.ndo_uninit		= team_uninit,
17133d249d4cSJiri Pirko 	.ndo_open		= team_open,
17143d249d4cSJiri Pirko 	.ndo_stop		= team_close,
17153d249d4cSJiri Pirko 	.ndo_start_xmit		= team_xmit,
17166c85f2bdSJiri Pirko 	.ndo_select_queue	= team_select_queue,
17173d249d4cSJiri Pirko 	.ndo_change_rx_flags	= team_change_rx_flags,
17183d249d4cSJiri Pirko 	.ndo_set_rx_mode	= team_set_rx_mode,
17193d249d4cSJiri Pirko 	.ndo_set_mac_address	= team_set_mac_address,
17203d249d4cSJiri Pirko 	.ndo_change_mtu		= team_change_mtu,
17213d249d4cSJiri Pirko 	.ndo_get_stats64	= team_get_stats64,
17223d249d4cSJiri Pirko 	.ndo_vlan_rx_add_vid	= team_vlan_rx_add_vid,
17233d249d4cSJiri Pirko 	.ndo_vlan_rx_kill_vid	= team_vlan_rx_kill_vid,
1724bd2d0837SJiri Pirko #ifdef CONFIG_NET_POLL_CONTROLLER
1725bd2d0837SJiri Pirko 	.ndo_poll_controller	= team_poll_controller,
1726bd2d0837SJiri Pirko 	.ndo_netpoll_setup	= team_netpoll_setup,
1727bd2d0837SJiri Pirko 	.ndo_netpoll_cleanup	= team_netpoll_cleanup,
1728bd2d0837SJiri Pirko #endif
17293d249d4cSJiri Pirko 	.ndo_add_slave		= team_add_slave,
17303d249d4cSJiri Pirko 	.ndo_del_slave		= team_del_slave,
1731234a8fd4SJiri Pirko 	.ndo_fix_features	= team_fix_features,
17323d249d4cSJiri Pirko };
17333d249d4cSJiri Pirko 
17343d249d4cSJiri Pirko 
17353d249d4cSJiri Pirko /***********************
17363d249d4cSJiri Pirko  * rt netlink interface
17373d249d4cSJiri Pirko  ***********************/
17383d249d4cSJiri Pirko 
17391d76efe1SJiri Pirko static void team_setup_by_port(struct net_device *dev,
17401d76efe1SJiri Pirko 			       struct net_device *port_dev)
17411d76efe1SJiri Pirko {
17421d76efe1SJiri Pirko 	dev->header_ops	= port_dev->header_ops;
17431d76efe1SJiri Pirko 	dev->type = port_dev->type;
17441d76efe1SJiri Pirko 	dev->hard_header_len = port_dev->hard_header_len;
17451d76efe1SJiri Pirko 	dev->addr_len = port_dev->addr_len;
17461d76efe1SJiri Pirko 	dev->mtu = port_dev->mtu;
17471d76efe1SJiri Pirko 	memcpy(dev->broadcast, port_dev->broadcast, port_dev->addr_len);
17481d76efe1SJiri Pirko 	memcpy(dev->dev_addr, port_dev->dev_addr, port_dev->addr_len);
17491d76efe1SJiri Pirko 	dev->addr_assign_type &= ~NET_ADDR_RANDOM;
17501d76efe1SJiri Pirko }
17511d76efe1SJiri Pirko 
17521d76efe1SJiri Pirko static int team_dev_type_check_change(struct net_device *dev,
17531d76efe1SJiri Pirko 				      struct net_device *port_dev)
17541d76efe1SJiri Pirko {
17551d76efe1SJiri Pirko 	struct team *team = netdev_priv(dev);
17561d76efe1SJiri Pirko 	char *portname = port_dev->name;
17571d76efe1SJiri Pirko 	int err;
17581d76efe1SJiri Pirko 
17591d76efe1SJiri Pirko 	if (dev->type == port_dev->type)
17601d76efe1SJiri Pirko 		return 0;
17611d76efe1SJiri Pirko 	if (!list_empty(&team->port_list)) {
17621d76efe1SJiri Pirko 		netdev_err(dev, "Device %s is of different type\n", portname);
17631d76efe1SJiri Pirko 		return -EBUSY;
17641d76efe1SJiri Pirko 	}
17651d76efe1SJiri Pirko 	err = call_netdevice_notifiers(NETDEV_PRE_TYPE_CHANGE, dev);
17661d76efe1SJiri Pirko 	err = notifier_to_errno(err);
17671d76efe1SJiri Pirko 	if (err) {
17681d76efe1SJiri Pirko 		netdev_err(dev, "Refused to change device type\n");
17691d76efe1SJiri Pirko 		return err;
17701d76efe1SJiri Pirko 	}
17711d76efe1SJiri Pirko 	dev_uc_flush(dev);
17721d76efe1SJiri Pirko 	dev_mc_flush(dev);
17731d76efe1SJiri Pirko 	team_setup_by_port(dev, port_dev);
17741d76efe1SJiri Pirko 	call_netdevice_notifiers(NETDEV_POST_TYPE_CHANGE, dev);
17751d76efe1SJiri Pirko 	return 0;
17761d76efe1SJiri Pirko }
17771d76efe1SJiri Pirko 
17783d249d4cSJiri Pirko static void team_setup(struct net_device *dev)
17793d249d4cSJiri Pirko {
17803d249d4cSJiri Pirko 	ether_setup(dev);
17813d249d4cSJiri Pirko 
17823d249d4cSJiri Pirko 	dev->netdev_ops = &team_netdev_ops;
17833d249d4cSJiri Pirko 	dev->destructor	= team_destructor;
17843d249d4cSJiri Pirko 	dev->tx_queue_len = 0;
17853d249d4cSJiri Pirko 	dev->flags |= IFF_MULTICAST;
17863d249d4cSJiri Pirko 	dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
17873d249d4cSJiri Pirko 
17883d249d4cSJiri Pirko 	/*
17893d249d4cSJiri Pirko 	 * Indicate we support unicast address filtering. That way core won't
17903d249d4cSJiri Pirko 	 * bring us to promisc mode in case a unicast addr is added.
17913d249d4cSJiri Pirko 	 * Let this up to underlay drivers.
17923d249d4cSJiri Pirko 	 */
17935a1d1c8cSJiri Pirko 	dev->priv_flags |= IFF_UNICAST_FLT | IFF_LIVE_ADDR_CHANGE;
17943d249d4cSJiri Pirko 
17953d249d4cSJiri Pirko 	dev->features |= NETIF_F_LLTX;
17963d249d4cSJiri Pirko 	dev->features |= NETIF_F_GRO;
17973ed71471SJiri Pirko 	dev->hw_features = TEAM_VLAN_FEATURES |
17983ed71471SJiri Pirko 			   NETIF_F_HW_VLAN_TX |
17993d249d4cSJiri Pirko 			   NETIF_F_HW_VLAN_RX |
18003d249d4cSJiri Pirko 			   NETIF_F_HW_VLAN_FILTER;
18013d249d4cSJiri Pirko 
18023ed71471SJiri Pirko 	dev->hw_features &= ~(NETIF_F_ALL_CSUM & ~NETIF_F_HW_CSUM);
18033d249d4cSJiri Pirko 	dev->features |= dev->hw_features;
18043d249d4cSJiri Pirko }
18053d249d4cSJiri Pirko 
18063d249d4cSJiri Pirko static int team_newlink(struct net *src_net, struct net_device *dev,
18073d249d4cSJiri Pirko 			struct nlattr *tb[], struct nlattr *data[])
18083d249d4cSJiri Pirko {
18093d249d4cSJiri Pirko 	int err;
18103d249d4cSJiri Pirko 
18113d249d4cSJiri Pirko 	if (tb[IFLA_ADDRESS] == NULL)
18127ce5d222SDanny Kukawka 		eth_hw_addr_random(dev);
18133d249d4cSJiri Pirko 
18143d249d4cSJiri Pirko 	err = register_netdevice(dev);
18153d249d4cSJiri Pirko 	if (err)
18163d249d4cSJiri Pirko 		return err;
18173d249d4cSJiri Pirko 
18183d249d4cSJiri Pirko 	return 0;
18193d249d4cSJiri Pirko }
18203d249d4cSJiri Pirko 
18213d249d4cSJiri Pirko static int team_validate(struct nlattr *tb[], struct nlattr *data[])
18223d249d4cSJiri Pirko {
18233d249d4cSJiri Pirko 	if (tb[IFLA_ADDRESS]) {
18243d249d4cSJiri Pirko 		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
18253d249d4cSJiri Pirko 			return -EINVAL;
18263d249d4cSJiri Pirko 		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
18273d249d4cSJiri Pirko 			return -EADDRNOTAVAIL;
18283d249d4cSJiri Pirko 	}
18293d249d4cSJiri Pirko 	return 0;
18303d249d4cSJiri Pirko }
18313d249d4cSJiri Pirko 
18326c85f2bdSJiri Pirko static unsigned int team_get_num_tx_queues(void)
18336c85f2bdSJiri Pirko {
18346c85f2bdSJiri Pirko 	return TEAM_DEFAULT_NUM_TX_QUEUES;
18356c85f2bdSJiri Pirko }
18366c85f2bdSJiri Pirko 
18376c85f2bdSJiri Pirko static unsigned int team_get_num_rx_queues(void)
18386c85f2bdSJiri Pirko {
18396c85f2bdSJiri Pirko 	return TEAM_DEFAULT_NUM_RX_QUEUES;
18406c85f2bdSJiri Pirko }
18416c85f2bdSJiri Pirko 
18423d249d4cSJiri Pirko static struct rtnl_link_ops team_link_ops __read_mostly = {
18433d249d4cSJiri Pirko 	.kind			= DRV_NAME,
18443d249d4cSJiri Pirko 	.priv_size		= sizeof(struct team),
18453d249d4cSJiri Pirko 	.setup			= team_setup,
18463d249d4cSJiri Pirko 	.newlink		= team_newlink,
18473d249d4cSJiri Pirko 	.validate		= team_validate,
18486c85f2bdSJiri Pirko 	.get_num_tx_queues	= team_get_num_tx_queues,
18496c85f2bdSJiri Pirko 	.get_num_rx_queues	= team_get_num_rx_queues,
18503d249d4cSJiri Pirko };
18513d249d4cSJiri Pirko 
18523d249d4cSJiri Pirko 
18533d249d4cSJiri Pirko /***********************************
18543d249d4cSJiri Pirko  * Generic netlink custom interface
18553d249d4cSJiri Pirko  ***********************************/
18563d249d4cSJiri Pirko 
18573d249d4cSJiri Pirko static struct genl_family team_nl_family = {
18583d249d4cSJiri Pirko 	.id		= GENL_ID_GENERATE,
18593d249d4cSJiri Pirko 	.name		= TEAM_GENL_NAME,
18603d249d4cSJiri Pirko 	.version	= TEAM_GENL_VERSION,
18613d249d4cSJiri Pirko 	.maxattr	= TEAM_ATTR_MAX,
18623d249d4cSJiri Pirko 	.netnsok	= true,
18633d249d4cSJiri Pirko };
18643d249d4cSJiri Pirko 
18653d249d4cSJiri Pirko static const struct nla_policy team_nl_policy[TEAM_ATTR_MAX + 1] = {
18663d249d4cSJiri Pirko 	[TEAM_ATTR_UNSPEC]			= { .type = NLA_UNSPEC, },
18673d249d4cSJiri Pirko 	[TEAM_ATTR_TEAM_IFINDEX]		= { .type = NLA_U32 },
18683d249d4cSJiri Pirko 	[TEAM_ATTR_LIST_OPTION]			= { .type = NLA_NESTED },
18693d249d4cSJiri Pirko 	[TEAM_ATTR_LIST_PORT]			= { .type = NLA_NESTED },
18703d249d4cSJiri Pirko };
18713d249d4cSJiri Pirko 
18723d249d4cSJiri Pirko static const struct nla_policy
18733d249d4cSJiri Pirko team_nl_option_policy[TEAM_ATTR_OPTION_MAX + 1] = {
18743d249d4cSJiri Pirko 	[TEAM_ATTR_OPTION_UNSPEC]		= { .type = NLA_UNSPEC, },
18753d249d4cSJiri Pirko 	[TEAM_ATTR_OPTION_NAME] = {
18763d249d4cSJiri Pirko 		.type = NLA_STRING,
18773d249d4cSJiri Pirko 		.len = TEAM_STRING_MAX_LEN,
18783d249d4cSJiri Pirko 	},
18793d249d4cSJiri Pirko 	[TEAM_ATTR_OPTION_CHANGED]		= { .type = NLA_FLAG },
18803d249d4cSJiri Pirko 	[TEAM_ATTR_OPTION_TYPE]			= { .type = NLA_U8 },
18812615598fSJiri Pirko 	[TEAM_ATTR_OPTION_DATA]			= { .type = NLA_BINARY },
18823d249d4cSJiri Pirko };
18833d249d4cSJiri Pirko 
18843d249d4cSJiri Pirko static int team_nl_cmd_noop(struct sk_buff *skb, struct genl_info *info)
18853d249d4cSJiri Pirko {
18863d249d4cSJiri Pirko 	struct sk_buff *msg;
18873d249d4cSJiri Pirko 	void *hdr;
18883d249d4cSJiri Pirko 	int err;
18893d249d4cSJiri Pirko 
189058050fceSThomas Graf 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
18913d249d4cSJiri Pirko 	if (!msg)
18923d249d4cSJiri Pirko 		return -ENOMEM;
18933d249d4cSJiri Pirko 
189415e47304SEric W. Biederman 	hdr = genlmsg_put(msg, info->snd_portid, info->snd_seq,
18953d249d4cSJiri Pirko 			  &team_nl_family, 0, TEAM_CMD_NOOP);
1896a326e6ddSWei Yongjun 	if (!hdr) {
1897a326e6ddSWei Yongjun 		err = -EMSGSIZE;
18983d249d4cSJiri Pirko 		goto err_msg_put;
18993d249d4cSJiri Pirko 	}
19003d249d4cSJiri Pirko 
19013d249d4cSJiri Pirko 	genlmsg_end(msg, hdr);
19023d249d4cSJiri Pirko 
190315e47304SEric W. Biederman 	return genlmsg_unicast(genl_info_net(info), msg, info->snd_portid);
19043d249d4cSJiri Pirko 
19053d249d4cSJiri Pirko err_msg_put:
19063d249d4cSJiri Pirko 	nlmsg_free(msg);
19073d249d4cSJiri Pirko 
19083d249d4cSJiri Pirko 	return err;
19093d249d4cSJiri Pirko }
19103d249d4cSJiri Pirko 
19113d249d4cSJiri Pirko /*
19123d249d4cSJiri Pirko  * Netlink cmd functions should be locked by following two functions.
19138c0713a5SJiri Pirko  * Since dev gets held here, that ensures dev won't disappear in between.
19143d249d4cSJiri Pirko  */
19153d249d4cSJiri Pirko static struct team *team_nl_team_get(struct genl_info *info)
19163d249d4cSJiri Pirko {
19173d249d4cSJiri Pirko 	struct net *net = genl_info_net(info);
19183d249d4cSJiri Pirko 	int ifindex;
19193d249d4cSJiri Pirko 	struct net_device *dev;
19203d249d4cSJiri Pirko 	struct team *team;
19213d249d4cSJiri Pirko 
19223d249d4cSJiri Pirko 	if (!info->attrs[TEAM_ATTR_TEAM_IFINDEX])
19233d249d4cSJiri Pirko 		return NULL;
19243d249d4cSJiri Pirko 
19253d249d4cSJiri Pirko 	ifindex = nla_get_u32(info->attrs[TEAM_ATTR_TEAM_IFINDEX]);
19268c0713a5SJiri Pirko 	dev = dev_get_by_index(net, ifindex);
19273d249d4cSJiri Pirko 	if (!dev || dev->netdev_ops != &team_netdev_ops) {
19288c0713a5SJiri Pirko 		if (dev)
19298c0713a5SJiri Pirko 			dev_put(dev);
19303d249d4cSJiri Pirko 		return NULL;
19313d249d4cSJiri Pirko 	}
19323d249d4cSJiri Pirko 
19333d249d4cSJiri Pirko 	team = netdev_priv(dev);
193461dc3461SJiri Pirko 	mutex_lock(&team->lock);
19353d249d4cSJiri Pirko 	return team;
19363d249d4cSJiri Pirko }
19373d249d4cSJiri Pirko 
19383d249d4cSJiri Pirko static void team_nl_team_put(struct team *team)
19393d249d4cSJiri Pirko {
194061dc3461SJiri Pirko 	mutex_unlock(&team->lock);
19418c0713a5SJiri Pirko 	dev_put(team->dev);
19423d249d4cSJiri Pirko }
19433d249d4cSJiri Pirko 
19443d249d4cSJiri Pirko static int team_nl_send_generic(struct genl_info *info, struct team *team,
19453d249d4cSJiri Pirko 				int (*fill_func)(struct sk_buff *skb,
19463d249d4cSJiri Pirko 						 struct genl_info *info,
19473d249d4cSJiri Pirko 						 int flags, struct team *team))
19483d249d4cSJiri Pirko {
19493d249d4cSJiri Pirko 	struct sk_buff *skb;
19503d249d4cSJiri Pirko 	int err;
19513d249d4cSJiri Pirko 
195258050fceSThomas Graf 	skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
19533d249d4cSJiri Pirko 	if (!skb)
19543d249d4cSJiri Pirko 		return -ENOMEM;
19553d249d4cSJiri Pirko 
19563d249d4cSJiri Pirko 	err = fill_func(skb, info, NLM_F_ACK, team);
19573d249d4cSJiri Pirko 	if (err < 0)
19583d249d4cSJiri Pirko 		goto err_fill;
19593d249d4cSJiri Pirko 
196015e47304SEric W. Biederman 	err = genlmsg_unicast(genl_info_net(info), skb, info->snd_portid);
19613d249d4cSJiri Pirko 	return err;
19623d249d4cSJiri Pirko 
19633d249d4cSJiri Pirko err_fill:
19643d249d4cSJiri Pirko 	nlmsg_free(skb);
19653d249d4cSJiri Pirko 	return err;
19663d249d4cSJiri Pirko }
19673d249d4cSJiri Pirko 
19689b00cf2dSJiri Pirko typedef int team_nl_send_func_t(struct sk_buff *skb,
196915e47304SEric W. Biederman 				struct team *team, u32 portid);
19709b00cf2dSJiri Pirko 
197115e47304SEric W. Biederman static int team_nl_send_unicast(struct sk_buff *skb, struct team *team, u32 portid)
19729b00cf2dSJiri Pirko {
197315e47304SEric W. Biederman 	return genlmsg_unicast(dev_net(team->dev), skb, portid);
19749b00cf2dSJiri Pirko }
19759b00cf2dSJiri Pirko 
197601048d9aSJiri Pirko static int team_nl_fill_one_option_get(struct sk_buff *skb, struct team *team,
197701048d9aSJiri Pirko 				       struct team_option_inst *opt_inst)
19783d249d4cSJiri Pirko {
19793d249d4cSJiri Pirko 	struct nlattr *option_item;
198080f7c668SJiri Pirko 	struct team_option *option = opt_inst->option;
19819b00cf2dSJiri Pirko 	struct team_option_inst_info *opt_inst_info = &opt_inst->info;
198280f7c668SJiri Pirko 	struct team_gsetter_ctx ctx;
198301048d9aSJiri Pirko 	int err;
19843d249d4cSJiri Pirko 
19859b00cf2dSJiri Pirko 	ctx.info = opt_inst_info;
19869b00cf2dSJiri Pirko 	err = team_option_get(team, opt_inst, &ctx);
19879b00cf2dSJiri Pirko 	if (err)
19889b00cf2dSJiri Pirko 		return err;
19899b00cf2dSJiri Pirko 
19903d249d4cSJiri Pirko 	option_item = nla_nest_start(skb, TEAM_ATTR_ITEM_OPTION);
19913d249d4cSJiri Pirko 	if (!option_item)
19929b00cf2dSJiri Pirko 		return -EMSGSIZE;
199385d59a87SJiri Pirko 
19949b00cf2dSJiri Pirko 	if (nla_put_string(skb, TEAM_ATTR_OPTION_NAME, option->name))
19959b00cf2dSJiri Pirko 		goto nest_cancel;
199685d59a87SJiri Pirko 	if (opt_inst_info->port &&
199780f7c668SJiri Pirko 	    nla_put_u32(skb, TEAM_ATTR_OPTION_PORT_IFINDEX,
199885d59a87SJiri Pirko 			opt_inst_info->port->dev->ifindex))
19999b00cf2dSJiri Pirko 		goto nest_cancel;
2000b1303326SJiri Pirko 	if (opt_inst->option->array_size &&
2001b1303326SJiri Pirko 	    nla_put_u32(skb, TEAM_ATTR_OPTION_ARRAY_INDEX,
200285d59a87SJiri Pirko 			opt_inst_info->array_index))
20039b00cf2dSJiri Pirko 		goto nest_cancel;
200485d59a87SJiri Pirko 
20053d249d4cSJiri Pirko 	switch (option->type) {
20063d249d4cSJiri Pirko 	case TEAM_OPTION_TYPE_U32:
200786ebb02dSDavid S. Miller 		if (nla_put_u8(skb, TEAM_ATTR_OPTION_TYPE, NLA_U32))
20089b00cf2dSJiri Pirko 			goto nest_cancel;
200901048d9aSJiri Pirko 		if (nla_put_u32(skb, TEAM_ATTR_OPTION_DATA, ctx.data.u32_val))
20109b00cf2dSJiri Pirko 			goto nest_cancel;
20113d249d4cSJiri Pirko 		break;
20123d249d4cSJiri Pirko 	case TEAM_OPTION_TYPE_STRING:
201386ebb02dSDavid S. Miller 		if (nla_put_u8(skb, TEAM_ATTR_OPTION_TYPE, NLA_STRING))
20149b00cf2dSJiri Pirko 			goto nest_cancel;
201586ebb02dSDavid S. Miller 		if (nla_put_string(skb, TEAM_ATTR_OPTION_DATA,
201680f7c668SJiri Pirko 				   ctx.data.str_val))
20179b00cf2dSJiri Pirko 			goto nest_cancel;
20183d249d4cSJiri Pirko 		break;
20192615598fSJiri Pirko 	case TEAM_OPTION_TYPE_BINARY:
20202615598fSJiri Pirko 		if (nla_put_u8(skb, TEAM_ATTR_OPTION_TYPE, NLA_BINARY))
20219b00cf2dSJiri Pirko 			goto nest_cancel;
202201048d9aSJiri Pirko 		if (nla_put(skb, TEAM_ATTR_OPTION_DATA, ctx.data.bin_val.len,
202301048d9aSJiri Pirko 			    ctx.data.bin_val.ptr))
20249b00cf2dSJiri Pirko 			goto nest_cancel;
20252615598fSJiri Pirko 		break;
202614f066baSJiri Pirko 	case TEAM_OPTION_TYPE_BOOL:
202714f066baSJiri Pirko 		if (nla_put_u8(skb, TEAM_ATTR_OPTION_TYPE, NLA_FLAG))
20289b00cf2dSJiri Pirko 			goto nest_cancel;
202914f066baSJiri Pirko 		if (ctx.data.bool_val &&
203014f066baSJiri Pirko 		    nla_put_flag(skb, TEAM_ATTR_OPTION_DATA))
20319b00cf2dSJiri Pirko 			goto nest_cancel;
203214f066baSJiri Pirko 		break;
203369821638SJiri Pirko 	case TEAM_OPTION_TYPE_S32:
203469821638SJiri Pirko 		if (nla_put_u8(skb, TEAM_ATTR_OPTION_TYPE, NLA_S32))
203569821638SJiri Pirko 			goto nest_cancel;
203669821638SJiri Pirko 		if (nla_put_s32(skb, TEAM_ATTR_OPTION_DATA, ctx.data.s32_val))
203769821638SJiri Pirko 			goto nest_cancel;
203869821638SJiri Pirko 		break;
20393d249d4cSJiri Pirko 	default:
20403d249d4cSJiri Pirko 		BUG();
20413d249d4cSJiri Pirko 	}
20429b00cf2dSJiri Pirko 	if (opt_inst->removed && nla_put_flag(skb, TEAM_ATTR_OPTION_REMOVED))
20439b00cf2dSJiri Pirko 		goto nest_cancel;
20449b00cf2dSJiri Pirko 	if (opt_inst->changed) {
20459b00cf2dSJiri Pirko 		if (nla_put_flag(skb, TEAM_ATTR_OPTION_CHANGED))
20469b00cf2dSJiri Pirko 			goto nest_cancel;
20479b00cf2dSJiri Pirko 		opt_inst->changed = false;
20489b00cf2dSJiri Pirko 	}
20493d249d4cSJiri Pirko 	nla_nest_end(skb, option_item);
205001048d9aSJiri Pirko 	return 0;
205101048d9aSJiri Pirko 
20529b00cf2dSJiri Pirko nest_cancel:
20539b00cf2dSJiri Pirko 	nla_nest_cancel(skb, option_item);
20549b00cf2dSJiri Pirko 	return -EMSGSIZE;
205501048d9aSJiri Pirko }
205601048d9aSJiri Pirko 
20579b00cf2dSJiri Pirko static int __send_and_alloc_skb(struct sk_buff **pskb,
205815e47304SEric W. Biederman 				struct team *team, u32 portid,
20599b00cf2dSJiri Pirko 				team_nl_send_func_t *send_func)
20609b00cf2dSJiri Pirko {
20619b00cf2dSJiri Pirko 	int err;
20629b00cf2dSJiri Pirko 
20639b00cf2dSJiri Pirko 	if (*pskb) {
206415e47304SEric W. Biederman 		err = send_func(*pskb, team, portid);
20659b00cf2dSJiri Pirko 		if (err)
20669b00cf2dSJiri Pirko 			return err;
20679b00cf2dSJiri Pirko 	}
206858050fceSThomas Graf 	*pskb = genlmsg_new(GENLMSG_DEFAULT_SIZE, GFP_KERNEL);
20699b00cf2dSJiri Pirko 	if (!*pskb)
20709b00cf2dSJiri Pirko 		return -ENOMEM;
20719b00cf2dSJiri Pirko 	return 0;
20729b00cf2dSJiri Pirko }
20739b00cf2dSJiri Pirko 
207415e47304SEric W. Biederman static int team_nl_send_options_get(struct team *team, u32 portid, u32 seq,
20759b00cf2dSJiri Pirko 				    int flags, team_nl_send_func_t *send_func,
207601048d9aSJiri Pirko 				    struct list_head *sel_opt_inst_list)
207701048d9aSJiri Pirko {
207801048d9aSJiri Pirko 	struct nlattr *option_list;
20799b00cf2dSJiri Pirko 	struct nlmsghdr *nlh;
208001048d9aSJiri Pirko 	void *hdr;
208101048d9aSJiri Pirko 	struct team_option_inst *opt_inst;
208201048d9aSJiri Pirko 	int err;
20839b00cf2dSJiri Pirko 	struct sk_buff *skb = NULL;
20849b00cf2dSJiri Pirko 	bool incomplete;
20859b00cf2dSJiri Pirko 	int i;
208601048d9aSJiri Pirko 
20879b00cf2dSJiri Pirko 	opt_inst = list_first_entry(sel_opt_inst_list,
20889b00cf2dSJiri Pirko 				    struct team_option_inst, tmp_list);
20899b00cf2dSJiri Pirko 
20909b00cf2dSJiri Pirko start_again:
209115e47304SEric W. Biederman 	err = __send_and_alloc_skb(&skb, team, portid, send_func);
20929b00cf2dSJiri Pirko 	if (err)
20939b00cf2dSJiri Pirko 		return err;
20949b00cf2dSJiri Pirko 
209515e47304SEric W. Biederman 	hdr = genlmsg_put(skb, portid, seq, &team_nl_family, flags | NLM_F_MULTI,
209601048d9aSJiri Pirko 			  TEAM_CMD_OPTIONS_GET);
2097a326e6ddSWei Yongjun 	if (!hdr)
2098a326e6ddSWei Yongjun 		return -EMSGSIZE;
209901048d9aSJiri Pirko 
210001048d9aSJiri Pirko 	if (nla_put_u32(skb, TEAM_ATTR_TEAM_IFINDEX, team->dev->ifindex))
210101048d9aSJiri Pirko 		goto nla_put_failure;
210201048d9aSJiri Pirko 	option_list = nla_nest_start(skb, TEAM_ATTR_LIST_OPTION);
210301048d9aSJiri Pirko 	if (!option_list)
210401048d9aSJiri Pirko 		goto nla_put_failure;
210501048d9aSJiri Pirko 
21069b00cf2dSJiri Pirko 	i = 0;
21079b00cf2dSJiri Pirko 	incomplete = false;
21089b00cf2dSJiri Pirko 	list_for_each_entry_from(opt_inst, sel_opt_inst_list, tmp_list) {
210901048d9aSJiri Pirko 		err = team_nl_fill_one_option_get(skb, team, opt_inst);
21109b00cf2dSJiri Pirko 		if (err) {
21119b00cf2dSJiri Pirko 			if (err == -EMSGSIZE) {
21129b00cf2dSJiri Pirko 				if (!i)
211301048d9aSJiri Pirko 					goto errout;
21149b00cf2dSJiri Pirko 				incomplete = true;
21159b00cf2dSJiri Pirko 				break;
21169b00cf2dSJiri Pirko 			}
21179b00cf2dSJiri Pirko 			goto errout;
21189b00cf2dSJiri Pirko 		}
21199b00cf2dSJiri Pirko 		i++;
21203d249d4cSJiri Pirko 	}
21213d249d4cSJiri Pirko 
21223d249d4cSJiri Pirko 	nla_nest_end(skb, option_list);
21239b00cf2dSJiri Pirko 	genlmsg_end(skb, hdr);
21249b00cf2dSJiri Pirko 	if (incomplete)
21259b00cf2dSJiri Pirko 		goto start_again;
21269b00cf2dSJiri Pirko 
21279b00cf2dSJiri Pirko send_done:
212815e47304SEric W. Biederman 	nlh = nlmsg_put(skb, portid, seq, NLMSG_DONE, 0, flags | NLM_F_MULTI);
21299b00cf2dSJiri Pirko 	if (!nlh) {
213015e47304SEric W. Biederman 		err = __send_and_alloc_skb(&skb, team, portid, send_func);
21319b00cf2dSJiri Pirko 		if (err)
21329b00cf2dSJiri Pirko 			goto errout;
21339b00cf2dSJiri Pirko 		goto send_done;
21349b00cf2dSJiri Pirko 	}
21359b00cf2dSJiri Pirko 
213615e47304SEric W. Biederman 	return send_func(skb, team, portid);
21373d249d4cSJiri Pirko 
21383d249d4cSJiri Pirko nla_put_failure:
213980f7c668SJiri Pirko 	err = -EMSGSIZE;
214080f7c668SJiri Pirko errout:
21413d249d4cSJiri Pirko 	genlmsg_cancel(skb, hdr);
21429b00cf2dSJiri Pirko 	nlmsg_free(skb);
214380f7c668SJiri Pirko 	return err;
21443d249d4cSJiri Pirko }
21453d249d4cSJiri Pirko 
21463d249d4cSJiri Pirko static int team_nl_cmd_options_get(struct sk_buff *skb, struct genl_info *info)
21473d249d4cSJiri Pirko {
21483d249d4cSJiri Pirko 	struct team *team;
21499b00cf2dSJiri Pirko 	struct team_option_inst *opt_inst;
21503d249d4cSJiri Pirko 	int err;
21519b00cf2dSJiri Pirko 	LIST_HEAD(sel_opt_inst_list);
21523d249d4cSJiri Pirko 
21533d249d4cSJiri Pirko 	team = team_nl_team_get(info);
21543d249d4cSJiri Pirko 	if (!team)
21553d249d4cSJiri Pirko 		return -EINVAL;
21563d249d4cSJiri Pirko 
21579b00cf2dSJiri Pirko 	list_for_each_entry(opt_inst, &team->option_inst_list, list)
21589b00cf2dSJiri Pirko 		list_add_tail(&opt_inst->tmp_list, &sel_opt_inst_list);
215915e47304SEric W. Biederman 	err = team_nl_send_options_get(team, info->snd_portid, info->snd_seq,
21609b00cf2dSJiri Pirko 				       NLM_F_ACK, team_nl_send_unicast,
21619b00cf2dSJiri Pirko 				       &sel_opt_inst_list);
21623d249d4cSJiri Pirko 
21633d249d4cSJiri Pirko 	team_nl_team_put(team);
21643d249d4cSJiri Pirko 
21653d249d4cSJiri Pirko 	return err;
21663d249d4cSJiri Pirko }
21673d249d4cSJiri Pirko 
21682fcdb2c9SJiri Pirko static int team_nl_send_event_options_get(struct team *team,
21692fcdb2c9SJiri Pirko 					  struct list_head *sel_opt_inst_list);
21702fcdb2c9SJiri Pirko 
21713d249d4cSJiri Pirko static int team_nl_cmd_options_set(struct sk_buff *skb, struct genl_info *info)
21723d249d4cSJiri Pirko {
21733d249d4cSJiri Pirko 	struct team *team;
21743d249d4cSJiri Pirko 	int err = 0;
21753d249d4cSJiri Pirko 	int i;
21763d249d4cSJiri Pirko 	struct nlattr *nl_option;
21772fcdb2c9SJiri Pirko 	LIST_HEAD(opt_inst_list);
21783d249d4cSJiri Pirko 
21793d249d4cSJiri Pirko 	team = team_nl_team_get(info);
21803d249d4cSJiri Pirko 	if (!team)
21813d249d4cSJiri Pirko 		return -EINVAL;
21823d249d4cSJiri Pirko 
21833d249d4cSJiri Pirko 	err = -EINVAL;
21843d249d4cSJiri Pirko 	if (!info->attrs[TEAM_ATTR_LIST_OPTION]) {
21853d249d4cSJiri Pirko 		err = -EINVAL;
21863d249d4cSJiri Pirko 		goto team_put;
21873d249d4cSJiri Pirko 	}
21883d249d4cSJiri Pirko 
21893d249d4cSJiri Pirko 	nla_for_each_nested(nl_option, info->attrs[TEAM_ATTR_LIST_OPTION], i) {
219080f7c668SJiri Pirko 		struct nlattr *opt_attrs[TEAM_ATTR_OPTION_MAX + 1];
2191b1303326SJiri Pirko 		struct nlattr *attr;
219214f066baSJiri Pirko 		struct nlattr *attr_data;
21933d249d4cSJiri Pirko 		enum team_option_type opt_type;
219480f7c668SJiri Pirko 		int opt_port_ifindex = 0; /* != 0 for per-port options */
2195b1303326SJiri Pirko 		u32 opt_array_index = 0;
2196b1303326SJiri Pirko 		bool opt_is_array = false;
219780f7c668SJiri Pirko 		struct team_option_inst *opt_inst;
21983d249d4cSJiri Pirko 		char *opt_name;
21993d249d4cSJiri Pirko 		bool opt_found = false;
22003d249d4cSJiri Pirko 
22013d249d4cSJiri Pirko 		if (nla_type(nl_option) != TEAM_ATTR_ITEM_OPTION) {
22023d249d4cSJiri Pirko 			err = -EINVAL;
22033d249d4cSJiri Pirko 			goto team_put;
22043d249d4cSJiri Pirko 		}
220580f7c668SJiri Pirko 		err = nla_parse_nested(opt_attrs, TEAM_ATTR_OPTION_MAX,
22063d249d4cSJiri Pirko 				       nl_option, team_nl_option_policy);
22073d249d4cSJiri Pirko 		if (err)
22083d249d4cSJiri Pirko 			goto team_put;
220980f7c668SJiri Pirko 		if (!opt_attrs[TEAM_ATTR_OPTION_NAME] ||
221014f066baSJiri Pirko 		    !opt_attrs[TEAM_ATTR_OPTION_TYPE]) {
22113d249d4cSJiri Pirko 			err = -EINVAL;
22123d249d4cSJiri Pirko 			goto team_put;
22133d249d4cSJiri Pirko 		}
221480f7c668SJiri Pirko 		switch (nla_get_u8(opt_attrs[TEAM_ATTR_OPTION_TYPE])) {
22153d249d4cSJiri Pirko 		case NLA_U32:
22163d249d4cSJiri Pirko 			opt_type = TEAM_OPTION_TYPE_U32;
22173d249d4cSJiri Pirko 			break;
22183d249d4cSJiri Pirko 		case NLA_STRING:
22193d249d4cSJiri Pirko 			opt_type = TEAM_OPTION_TYPE_STRING;
22203d249d4cSJiri Pirko 			break;
22212615598fSJiri Pirko 		case NLA_BINARY:
22222615598fSJiri Pirko 			opt_type = TEAM_OPTION_TYPE_BINARY;
22232615598fSJiri Pirko 			break;
222414f066baSJiri Pirko 		case NLA_FLAG:
222514f066baSJiri Pirko 			opt_type = TEAM_OPTION_TYPE_BOOL;
222614f066baSJiri Pirko 			break;
222769821638SJiri Pirko 		case NLA_S32:
222869821638SJiri Pirko 			opt_type = TEAM_OPTION_TYPE_S32;
222969821638SJiri Pirko 			break;
22303d249d4cSJiri Pirko 		default:
22313d249d4cSJiri Pirko 			goto team_put;
22323d249d4cSJiri Pirko 		}
22333d249d4cSJiri Pirko 
223414f066baSJiri Pirko 		attr_data = opt_attrs[TEAM_ATTR_OPTION_DATA];
223514f066baSJiri Pirko 		if (opt_type != TEAM_OPTION_TYPE_BOOL && !attr_data) {
223614f066baSJiri Pirko 			err = -EINVAL;
223714f066baSJiri Pirko 			goto team_put;
223814f066baSJiri Pirko 		}
223914f066baSJiri Pirko 
224080f7c668SJiri Pirko 		opt_name = nla_data(opt_attrs[TEAM_ATTR_OPTION_NAME]);
2241b1303326SJiri Pirko 		attr = opt_attrs[TEAM_ATTR_OPTION_PORT_IFINDEX];
2242b1303326SJiri Pirko 		if (attr)
2243b1303326SJiri Pirko 			opt_port_ifindex = nla_get_u32(attr);
2244b1303326SJiri Pirko 
2245b1303326SJiri Pirko 		attr = opt_attrs[TEAM_ATTR_OPTION_ARRAY_INDEX];
2246b1303326SJiri Pirko 		if (attr) {
2247b1303326SJiri Pirko 			opt_is_array = true;
2248b1303326SJiri Pirko 			opt_array_index = nla_get_u32(attr);
2249b1303326SJiri Pirko 		}
22503d249d4cSJiri Pirko 
225180f7c668SJiri Pirko 		list_for_each_entry(opt_inst, &team->option_inst_list, list) {
225280f7c668SJiri Pirko 			struct team_option *option = opt_inst->option;
225380f7c668SJiri Pirko 			struct team_gsetter_ctx ctx;
225485d59a87SJiri Pirko 			struct team_option_inst_info *opt_inst_info;
225580f7c668SJiri Pirko 			int tmp_ifindex;
225680f7c668SJiri Pirko 
225785d59a87SJiri Pirko 			opt_inst_info = &opt_inst->info;
225885d59a87SJiri Pirko 			tmp_ifindex = opt_inst_info->port ?
225985d59a87SJiri Pirko 				      opt_inst_info->port->dev->ifindex : 0;
22603d249d4cSJiri Pirko 			if (option->type != opt_type ||
226180f7c668SJiri Pirko 			    strcmp(option->name, opt_name) ||
2262b1303326SJiri Pirko 			    tmp_ifindex != opt_port_ifindex ||
2263b1303326SJiri Pirko 			    (option->array_size && !opt_is_array) ||
226485d59a87SJiri Pirko 			    opt_inst_info->array_index != opt_array_index)
22653d249d4cSJiri Pirko 				continue;
22663d249d4cSJiri Pirko 			opt_found = true;
226785d59a87SJiri Pirko 			ctx.info = opt_inst_info;
22683d249d4cSJiri Pirko 			switch (opt_type) {
22693d249d4cSJiri Pirko 			case TEAM_OPTION_TYPE_U32:
227014f066baSJiri Pirko 				ctx.data.u32_val = nla_get_u32(attr_data);
22713d249d4cSJiri Pirko 				break;
22723d249d4cSJiri Pirko 			case TEAM_OPTION_TYPE_STRING:
227314f066baSJiri Pirko 				if (nla_len(attr_data) > TEAM_STRING_MAX_LEN) {
22742615598fSJiri Pirko 					err = -EINVAL;
22752615598fSJiri Pirko 					goto team_put;
22762615598fSJiri Pirko 				}
227714f066baSJiri Pirko 				ctx.data.str_val = nla_data(attr_data);
22783d249d4cSJiri Pirko 				break;
22792615598fSJiri Pirko 			case TEAM_OPTION_TYPE_BINARY:
228014f066baSJiri Pirko 				ctx.data.bin_val.len = nla_len(attr_data);
228114f066baSJiri Pirko 				ctx.data.bin_val.ptr = nla_data(attr_data);
228214f066baSJiri Pirko 				break;
228314f066baSJiri Pirko 			case TEAM_OPTION_TYPE_BOOL:
228414f066baSJiri Pirko 				ctx.data.bool_val = attr_data ? true : false;
22852615598fSJiri Pirko 				break;
228669821638SJiri Pirko 			case TEAM_OPTION_TYPE_S32:
228769821638SJiri Pirko 				ctx.data.s32_val = nla_get_s32(attr_data);
228869821638SJiri Pirko 				break;
22893d249d4cSJiri Pirko 			default:
22903d249d4cSJiri Pirko 				BUG();
22913d249d4cSJiri Pirko 			}
229280f7c668SJiri Pirko 			err = team_option_set(team, opt_inst, &ctx);
22933d249d4cSJiri Pirko 			if (err)
22943d249d4cSJiri Pirko 				goto team_put;
22952fcdb2c9SJiri Pirko 			opt_inst->changed = true;
22962fcdb2c9SJiri Pirko 			list_add(&opt_inst->tmp_list, &opt_inst_list);
22973d249d4cSJiri Pirko 		}
22983d249d4cSJiri Pirko 		if (!opt_found) {
22993d249d4cSJiri Pirko 			err = -ENOENT;
23003d249d4cSJiri Pirko 			goto team_put;
23013d249d4cSJiri Pirko 		}
23023d249d4cSJiri Pirko 	}
23033d249d4cSJiri Pirko 
23042fcdb2c9SJiri Pirko 	err = team_nl_send_event_options_get(team, &opt_inst_list);
23052fcdb2c9SJiri Pirko 
23063d249d4cSJiri Pirko team_put:
23073d249d4cSJiri Pirko 	team_nl_team_put(team);
23083d249d4cSJiri Pirko 
23093d249d4cSJiri Pirko 	return err;
23103d249d4cSJiri Pirko }
23113d249d4cSJiri Pirko 
2312b82b9183SJiri Pirko static int team_nl_fill_port_list_get(struct sk_buff *skb,
231315e47304SEric W. Biederman 				      u32 portid, u32 seq, int flags,
23143d249d4cSJiri Pirko 				      struct team *team,
2315b82b9183SJiri Pirko 				      bool fillall)
23163d249d4cSJiri Pirko {
23173d249d4cSJiri Pirko 	struct nlattr *port_list;
23183d249d4cSJiri Pirko 	void *hdr;
23193d249d4cSJiri Pirko 	struct team_port *port;
23203d249d4cSJiri Pirko 
232115e47304SEric W. Biederman 	hdr = genlmsg_put(skb, portid, seq, &team_nl_family, flags,
23223d249d4cSJiri Pirko 			  TEAM_CMD_PORT_LIST_GET);
2323a326e6ddSWei Yongjun 	if (!hdr)
2324a326e6ddSWei Yongjun 		return -EMSGSIZE;
23253d249d4cSJiri Pirko 
232686ebb02dSDavid S. Miller 	if (nla_put_u32(skb, TEAM_ATTR_TEAM_IFINDEX, team->dev->ifindex))
232786ebb02dSDavid S. Miller 		goto nla_put_failure;
23283d249d4cSJiri Pirko 	port_list = nla_nest_start(skb, TEAM_ATTR_LIST_PORT);
23293d249d4cSJiri Pirko 	if (!port_list)
23303221c646SJiri Pirko 		goto nla_put_failure;
23313d249d4cSJiri Pirko 
23323d249d4cSJiri Pirko 	list_for_each_entry(port, &team->port_list, list) {
23333d249d4cSJiri Pirko 		struct nlattr *port_item;
23343d249d4cSJiri Pirko 
2335b82b9183SJiri Pirko 		/* Include only changed ports if fill all mode is not on */
2336b82b9183SJiri Pirko 		if (!fillall && !port->changed)
2337b82b9183SJiri Pirko 			continue;
23383d249d4cSJiri Pirko 		port_item = nla_nest_start(skb, TEAM_ATTR_ITEM_PORT);
23393d249d4cSJiri Pirko 		if (!port_item)
23403d249d4cSJiri Pirko 			goto nla_put_failure;
234186ebb02dSDavid S. Miller 		if (nla_put_u32(skb, TEAM_ATTR_PORT_IFINDEX, port->dev->ifindex))
234286ebb02dSDavid S. Miller 			goto nla_put_failure;
2343b82b9183SJiri Pirko 		if (port->changed) {
234486ebb02dSDavid S. Miller 			if (nla_put_flag(skb, TEAM_ATTR_PORT_CHANGED))
234586ebb02dSDavid S. Miller 				goto nla_put_failure;
2346b82b9183SJiri Pirko 			port->changed = false;
2347b82b9183SJiri Pirko 		}
234886ebb02dSDavid S. Miller 		if ((port->removed &&
234986ebb02dSDavid S. Miller 		     nla_put_flag(skb, TEAM_ATTR_PORT_REMOVED)) ||
235071472ec1SJiri Pirko 		    (port->state.linkup &&
235186ebb02dSDavid S. Miller 		     nla_put_flag(skb, TEAM_ATTR_PORT_LINKUP)) ||
235271472ec1SJiri Pirko 		    nla_put_u32(skb, TEAM_ATTR_PORT_SPEED, port->state.speed) ||
235371472ec1SJiri Pirko 		    nla_put_u8(skb, TEAM_ATTR_PORT_DUPLEX, port->state.duplex))
235486ebb02dSDavid S. Miller 			goto nla_put_failure;
23553d249d4cSJiri Pirko 		nla_nest_end(skb, port_item);
23563d249d4cSJiri Pirko 	}
23573d249d4cSJiri Pirko 
23583d249d4cSJiri Pirko 	nla_nest_end(skb, port_list);
23593d249d4cSJiri Pirko 	return genlmsg_end(skb, hdr);
23603d249d4cSJiri Pirko 
23613d249d4cSJiri Pirko nla_put_failure:
23623d249d4cSJiri Pirko 	genlmsg_cancel(skb, hdr);
23633d249d4cSJiri Pirko 	return -EMSGSIZE;
23643d249d4cSJiri Pirko }
23653d249d4cSJiri Pirko 
2366b82b9183SJiri Pirko static int team_nl_fill_port_list_get_all(struct sk_buff *skb,
23673d249d4cSJiri Pirko 					  struct genl_info *info, int flags,
23683d249d4cSJiri Pirko 					  struct team *team)
23693d249d4cSJiri Pirko {
237015e47304SEric W. Biederman 	return team_nl_fill_port_list_get(skb, info->snd_portid,
23713d249d4cSJiri Pirko 					  info->snd_seq, NLM_F_ACK,
2372b82b9183SJiri Pirko 					  team, true);
23733d249d4cSJiri Pirko }
23743d249d4cSJiri Pirko 
23753d249d4cSJiri Pirko static int team_nl_cmd_port_list_get(struct sk_buff *skb,
23763d249d4cSJiri Pirko 				     struct genl_info *info)
23773d249d4cSJiri Pirko {
23783d249d4cSJiri Pirko 	struct team *team;
23793d249d4cSJiri Pirko 	int err;
23803d249d4cSJiri Pirko 
23813d249d4cSJiri Pirko 	team = team_nl_team_get(info);
23823d249d4cSJiri Pirko 	if (!team)
23833d249d4cSJiri Pirko 		return -EINVAL;
23843d249d4cSJiri Pirko 
2385b82b9183SJiri Pirko 	err = team_nl_send_generic(info, team, team_nl_fill_port_list_get_all);
23863d249d4cSJiri Pirko 
23873d249d4cSJiri Pirko 	team_nl_team_put(team);
23883d249d4cSJiri Pirko 
23893d249d4cSJiri Pirko 	return err;
23903d249d4cSJiri Pirko }
23913d249d4cSJiri Pirko 
23923d249d4cSJiri Pirko static struct genl_ops team_nl_ops[] = {
23933d249d4cSJiri Pirko 	{
23943d249d4cSJiri Pirko 		.cmd = TEAM_CMD_NOOP,
23953d249d4cSJiri Pirko 		.doit = team_nl_cmd_noop,
23963d249d4cSJiri Pirko 		.policy = team_nl_policy,
23973d249d4cSJiri Pirko 	},
23983d249d4cSJiri Pirko 	{
23993d249d4cSJiri Pirko 		.cmd = TEAM_CMD_OPTIONS_SET,
24003d249d4cSJiri Pirko 		.doit = team_nl_cmd_options_set,
24013d249d4cSJiri Pirko 		.policy = team_nl_policy,
24023d249d4cSJiri Pirko 		.flags = GENL_ADMIN_PERM,
24033d249d4cSJiri Pirko 	},
24043d249d4cSJiri Pirko 	{
24053d249d4cSJiri Pirko 		.cmd = TEAM_CMD_OPTIONS_GET,
24063d249d4cSJiri Pirko 		.doit = team_nl_cmd_options_get,
24073d249d4cSJiri Pirko 		.policy = team_nl_policy,
24083d249d4cSJiri Pirko 		.flags = GENL_ADMIN_PERM,
24093d249d4cSJiri Pirko 	},
24103d249d4cSJiri Pirko 	{
24113d249d4cSJiri Pirko 		.cmd = TEAM_CMD_PORT_LIST_GET,
24123d249d4cSJiri Pirko 		.doit = team_nl_cmd_port_list_get,
24133d249d4cSJiri Pirko 		.policy = team_nl_policy,
24143d249d4cSJiri Pirko 		.flags = GENL_ADMIN_PERM,
24153d249d4cSJiri Pirko 	},
24163d249d4cSJiri Pirko };
24173d249d4cSJiri Pirko 
24183d249d4cSJiri Pirko static struct genl_multicast_group team_change_event_mcgrp = {
24193d249d4cSJiri Pirko 	.name = TEAM_GENL_CHANGE_EVENT_MC_GRP_NAME,
24203d249d4cSJiri Pirko };
24213d249d4cSJiri Pirko 
24229b00cf2dSJiri Pirko static int team_nl_send_multicast(struct sk_buff *skb,
242315e47304SEric W. Biederman 				  struct team *team, u32 portid)
24249b00cf2dSJiri Pirko {
24259b00cf2dSJiri Pirko 	return genlmsg_multicast_netns(dev_net(team->dev), skb, 0,
24269b00cf2dSJiri Pirko 				       team_change_event_mcgrp.id, GFP_KERNEL);
24279b00cf2dSJiri Pirko }
24289b00cf2dSJiri Pirko 
242901048d9aSJiri Pirko static int team_nl_send_event_options_get(struct team *team,
243001048d9aSJiri Pirko 					  struct list_head *sel_opt_inst_list)
24313d249d4cSJiri Pirko {
24329b00cf2dSJiri Pirko 	return team_nl_send_options_get(team, 0, 0, 0, team_nl_send_multicast,
24339b00cf2dSJiri Pirko 					sel_opt_inst_list);
24343d249d4cSJiri Pirko }
24353d249d4cSJiri Pirko 
2436b82b9183SJiri Pirko static int team_nl_send_event_port_list_get(struct team *team)
24373d249d4cSJiri Pirko {
24383d249d4cSJiri Pirko 	struct sk_buff *skb;
24393d249d4cSJiri Pirko 	int err;
2440b82b9183SJiri Pirko 	struct net *net = dev_net(team->dev);
24413d249d4cSJiri Pirko 
244258050fceSThomas Graf 	skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
24433d249d4cSJiri Pirko 	if (!skb)
24443d249d4cSJiri Pirko 		return -ENOMEM;
24453d249d4cSJiri Pirko 
2446b82b9183SJiri Pirko 	err = team_nl_fill_port_list_get(skb, 0, 0, 0, team, false);
24473d249d4cSJiri Pirko 	if (err < 0)
24483d249d4cSJiri Pirko 		goto err_fill;
24493d249d4cSJiri Pirko 
24503d249d4cSJiri Pirko 	err = genlmsg_multicast_netns(net, skb, 0, team_change_event_mcgrp.id,
24513d249d4cSJiri Pirko 				      GFP_KERNEL);
24523d249d4cSJiri Pirko 	return err;
24533d249d4cSJiri Pirko 
24543d249d4cSJiri Pirko err_fill:
24553d249d4cSJiri Pirko 	nlmsg_free(skb);
24563d249d4cSJiri Pirko 	return err;
24573d249d4cSJiri Pirko }
24583d249d4cSJiri Pirko 
24593d249d4cSJiri Pirko static int team_nl_init(void)
24603d249d4cSJiri Pirko {
24613d249d4cSJiri Pirko 	int err;
24623d249d4cSJiri Pirko 
24633d249d4cSJiri Pirko 	err = genl_register_family_with_ops(&team_nl_family, team_nl_ops,
24643d249d4cSJiri Pirko 					    ARRAY_SIZE(team_nl_ops));
24653d249d4cSJiri Pirko 	if (err)
24663d249d4cSJiri Pirko 		return err;
24673d249d4cSJiri Pirko 
24683d249d4cSJiri Pirko 	err = genl_register_mc_group(&team_nl_family, &team_change_event_mcgrp);
24693d249d4cSJiri Pirko 	if (err)
24703d249d4cSJiri Pirko 		goto err_change_event_grp_reg;
24713d249d4cSJiri Pirko 
24723d249d4cSJiri Pirko 	return 0;
24733d249d4cSJiri Pirko 
24743d249d4cSJiri Pirko err_change_event_grp_reg:
24753d249d4cSJiri Pirko 	genl_unregister_family(&team_nl_family);
24763d249d4cSJiri Pirko 
24773d249d4cSJiri Pirko 	return err;
24783d249d4cSJiri Pirko }
24793d249d4cSJiri Pirko 
24803d249d4cSJiri Pirko static void team_nl_fini(void)
24813d249d4cSJiri Pirko {
24823d249d4cSJiri Pirko 	genl_unregister_family(&team_nl_family);
24833d249d4cSJiri Pirko }
24843d249d4cSJiri Pirko 
24853d249d4cSJiri Pirko 
24863d249d4cSJiri Pirko /******************
24873d249d4cSJiri Pirko  * Change checkers
24883d249d4cSJiri Pirko  ******************/
24893d249d4cSJiri Pirko 
2490b82b9183SJiri Pirko static void __team_options_change_check(struct team *team)
24913d249d4cSJiri Pirko {
24923d249d4cSJiri Pirko 	int err;
249301048d9aSJiri Pirko 	struct team_option_inst *opt_inst;
249401048d9aSJiri Pirko 	LIST_HEAD(sel_opt_inst_list);
24953d249d4cSJiri Pirko 
249601048d9aSJiri Pirko 	list_for_each_entry(opt_inst, &team->option_inst_list, list) {
249701048d9aSJiri Pirko 		if (opt_inst->changed)
249801048d9aSJiri Pirko 			list_add_tail(&opt_inst->tmp_list, &sel_opt_inst_list);
249901048d9aSJiri Pirko 	}
250001048d9aSJiri Pirko 	err = team_nl_send_event_options_get(team, &sel_opt_inst_list);
25010c7517e9SJiri Pirko 	if (err && err != -ESRCH)
25029b00cf2dSJiri Pirko 		netdev_warn(team->dev, "Failed to send options change via netlink (err %d)\n",
25039b00cf2dSJiri Pirko 			    err);
25043d249d4cSJiri Pirko }
25053d249d4cSJiri Pirko 
25063d249d4cSJiri Pirko /* rtnl lock is held */
250710f3f51dSJiri Pirko 
250810f3f51dSJiri Pirko static void __team_port_change_send(struct team_port *port, bool linkup)
25093d249d4cSJiri Pirko {
25103d249d4cSJiri Pirko 	int err;
25113d249d4cSJiri Pirko 
2512b82b9183SJiri Pirko 	port->changed = true;
251371472ec1SJiri Pirko 	port->state.linkup = linkup;
251471472ec1SJiri Pirko 	team_refresh_port_linkup(port);
25153d249d4cSJiri Pirko 	if (linkup) {
25163d249d4cSJiri Pirko 		struct ethtool_cmd ecmd;
25173d249d4cSJiri Pirko 
25183d249d4cSJiri Pirko 		err = __ethtool_get_settings(port->dev, &ecmd);
25193d249d4cSJiri Pirko 		if (!err) {
252071472ec1SJiri Pirko 			port->state.speed = ethtool_cmd_speed(&ecmd);
252171472ec1SJiri Pirko 			port->state.duplex = ecmd.duplex;
25223d249d4cSJiri Pirko 			goto send_event;
25233d249d4cSJiri Pirko 		}
25243d249d4cSJiri Pirko 	}
252571472ec1SJiri Pirko 	port->state.speed = 0;
252671472ec1SJiri Pirko 	port->state.duplex = 0;
25273d249d4cSJiri Pirko 
25283d249d4cSJiri Pirko send_event:
2529b82b9183SJiri Pirko 	err = team_nl_send_event_port_list_get(port->team);
25300c7517e9SJiri Pirko 	if (err && err != -ESRCH)
25310c7517e9SJiri Pirko 		netdev_warn(port->team->dev, "Failed to send port change of device %s via netlink (err %d)\n",
25320c7517e9SJiri Pirko 			    port->dev->name, err);
25333d249d4cSJiri Pirko 
25343d249d4cSJiri Pirko }
25353d249d4cSJiri Pirko 
253610f3f51dSJiri Pirko static void __team_port_change_check(struct team_port *port, bool linkup)
253710f3f51dSJiri Pirko {
253810f3f51dSJiri Pirko 	if (port->state.linkup != linkup)
253910f3f51dSJiri Pirko 		__team_port_change_send(port, linkup);
254010f3f51dSJiri Pirko }
254110f3f51dSJiri Pirko 
254210f3f51dSJiri Pirko static void __team_port_change_port_added(struct team_port *port, bool linkup)
254310f3f51dSJiri Pirko {
254410f3f51dSJiri Pirko 	__team_port_change_send(port, linkup);
254510f3f51dSJiri Pirko }
254610f3f51dSJiri Pirko 
254710f3f51dSJiri Pirko static void __team_port_change_port_removed(struct team_port *port)
254810f3f51dSJiri Pirko {
254910f3f51dSJiri Pirko 	port->removed = true;
255010f3f51dSJiri Pirko 	__team_port_change_send(port, false);
255110f3f51dSJiri Pirko }
255210f3f51dSJiri Pirko 
25533d249d4cSJiri Pirko static void team_port_change_check(struct team_port *port, bool linkup)
25543d249d4cSJiri Pirko {
25553d249d4cSJiri Pirko 	struct team *team = port->team;
25563d249d4cSJiri Pirko 
255761dc3461SJiri Pirko 	mutex_lock(&team->lock);
25583d249d4cSJiri Pirko 	__team_port_change_check(port, linkup);
255961dc3461SJiri Pirko 	mutex_unlock(&team->lock);
25603d249d4cSJiri Pirko }
25613d249d4cSJiri Pirko 
25620f1aad2bSJiri Pirko 
25633d249d4cSJiri Pirko /************************************
25643d249d4cSJiri Pirko  * Net device notifier event handler
25653d249d4cSJiri Pirko  ************************************/
25663d249d4cSJiri Pirko 
25673d249d4cSJiri Pirko static int team_device_event(struct notifier_block *unused,
25683d249d4cSJiri Pirko 			     unsigned long event, void *ptr)
25693d249d4cSJiri Pirko {
25703d249d4cSJiri Pirko 	struct net_device *dev = (struct net_device *) ptr;
25713d249d4cSJiri Pirko 	struct team_port *port;
25723d249d4cSJiri Pirko 
25733d249d4cSJiri Pirko 	port = team_port_get_rtnl(dev);
25743d249d4cSJiri Pirko 	if (!port)
25753d249d4cSJiri Pirko 		return NOTIFY_DONE;
25763d249d4cSJiri Pirko 
25773d249d4cSJiri Pirko 	switch (event) {
25783d249d4cSJiri Pirko 	case NETDEV_UP:
25793d249d4cSJiri Pirko 		if (netif_carrier_ok(dev))
25803d249d4cSJiri Pirko 			team_port_change_check(port, true);
25813d249d4cSJiri Pirko 	case NETDEV_DOWN:
25823d249d4cSJiri Pirko 		team_port_change_check(port, false);
25833d249d4cSJiri Pirko 	case NETDEV_CHANGE:
25843d249d4cSJiri Pirko 		if (netif_running(port->dev))
25853d249d4cSJiri Pirko 			team_port_change_check(port,
25863d249d4cSJiri Pirko 					       !!netif_carrier_ok(port->dev));
25873d249d4cSJiri Pirko 		break;
25883d249d4cSJiri Pirko 	case NETDEV_UNREGISTER:
25893d249d4cSJiri Pirko 		team_del_slave(port->team->dev, dev);
25903d249d4cSJiri Pirko 		break;
25913d249d4cSJiri Pirko 	case NETDEV_FEAT_CHANGE:
25923d249d4cSJiri Pirko 		team_compute_features(port->team);
25933d249d4cSJiri Pirko 		break;
25943d249d4cSJiri Pirko 	case NETDEV_CHANGEMTU:
25953d249d4cSJiri Pirko 		/* Forbid to change mtu of underlaying device */
25963d249d4cSJiri Pirko 		return NOTIFY_BAD;
25973d249d4cSJiri Pirko 	case NETDEV_PRE_TYPE_CHANGE:
25983d249d4cSJiri Pirko 		/* Forbid to change type of underlaying device */
25993d249d4cSJiri Pirko 		return NOTIFY_BAD;
26003d249d4cSJiri Pirko 	}
26013d249d4cSJiri Pirko 	return NOTIFY_DONE;
26023d249d4cSJiri Pirko }
26033d249d4cSJiri Pirko 
26043d249d4cSJiri Pirko static struct notifier_block team_notifier_block __read_mostly = {
26053d249d4cSJiri Pirko 	.notifier_call = team_device_event,
26063d249d4cSJiri Pirko };
26073d249d4cSJiri Pirko 
26083d249d4cSJiri Pirko 
26093d249d4cSJiri Pirko /***********************
26103d249d4cSJiri Pirko  * Module init and exit
26113d249d4cSJiri Pirko  ***********************/
26123d249d4cSJiri Pirko 
26133d249d4cSJiri Pirko static int __init team_module_init(void)
26143d249d4cSJiri Pirko {
26153d249d4cSJiri Pirko 	int err;
26163d249d4cSJiri Pirko 
26173d249d4cSJiri Pirko 	register_netdevice_notifier(&team_notifier_block);
26183d249d4cSJiri Pirko 
26193d249d4cSJiri Pirko 	err = rtnl_link_register(&team_link_ops);
26203d249d4cSJiri Pirko 	if (err)
26213d249d4cSJiri Pirko 		goto err_rtnl_reg;
26223d249d4cSJiri Pirko 
26233d249d4cSJiri Pirko 	err = team_nl_init();
26243d249d4cSJiri Pirko 	if (err)
26253d249d4cSJiri Pirko 		goto err_nl_init;
26263d249d4cSJiri Pirko 
26273d249d4cSJiri Pirko 	return 0;
26283d249d4cSJiri Pirko 
26293d249d4cSJiri Pirko err_nl_init:
26303d249d4cSJiri Pirko 	rtnl_link_unregister(&team_link_ops);
26313d249d4cSJiri Pirko 
26323d249d4cSJiri Pirko err_rtnl_reg:
26333d249d4cSJiri Pirko 	unregister_netdevice_notifier(&team_notifier_block);
26343d249d4cSJiri Pirko 
26353d249d4cSJiri Pirko 	return err;
26363d249d4cSJiri Pirko }
26373d249d4cSJiri Pirko 
26383d249d4cSJiri Pirko static void __exit team_module_exit(void)
26393d249d4cSJiri Pirko {
26403d249d4cSJiri Pirko 	team_nl_fini();
26413d249d4cSJiri Pirko 	rtnl_link_unregister(&team_link_ops);
26423d249d4cSJiri Pirko 	unregister_netdevice_notifier(&team_notifier_block);
26433d249d4cSJiri Pirko }
26443d249d4cSJiri Pirko 
26453d249d4cSJiri Pirko module_init(team_module_init);
26463d249d4cSJiri Pirko module_exit(team_module_exit);
26473d249d4cSJiri Pirko 
26483d249d4cSJiri Pirko MODULE_LICENSE("GPL v2");
26493d249d4cSJiri Pirko MODULE_AUTHOR("Jiri Pirko <jpirko@redhat.com>");
26503d249d4cSJiri Pirko MODULE_DESCRIPTION("Ethernet team device driver");
26513d249d4cSJiri Pirko MODULE_ALIAS_RTNL_LINK(DRV_NAME);
2652