1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * drivers/net/team/team_mode_activebackup.c - Active-backup mode for team
4  * Copyright (c) 2011 Jiri Pirko <jpirko@redhat.com>
5  */
6 
7 #include <linux/kernel.h>
8 #include <linux/types.h>
9 #include <linux/module.h>
10 #include <linux/init.h>
11 #include <linux/errno.h>
12 #include <linux/netdevice.h>
13 #include <net/rtnetlink.h>
14 #include <linux/if_team.h>
15 
16 struct ab_priv {
17 	struct team_port __rcu *active_port;
18 	struct team_option_inst_info *ap_opt_inst_info;
19 };
20 
ab_priv(struct team * team)21 static struct ab_priv *ab_priv(struct team *team)
22 {
23 	return (struct ab_priv *) &team->mode_priv;
24 }
25 
ab_receive(struct team * team,struct team_port * port,struct sk_buff * skb)26 static rx_handler_result_t ab_receive(struct team *team, struct team_port *port,
27 				      struct sk_buff *skb) {
28 	struct team_port *active_port;
29 
30 	active_port = rcu_dereference(ab_priv(team)->active_port);
31 	if (active_port != port)
32 		return RX_HANDLER_EXACT;
33 	return RX_HANDLER_ANOTHER;
34 }
35 
ab_transmit(struct team * team,struct sk_buff * skb)36 static bool ab_transmit(struct team *team, struct sk_buff *skb)
37 {
38 	struct team_port *active_port;
39 
40 	active_port = rcu_dereference_bh(ab_priv(team)->active_port);
41 	if (unlikely(!active_port))
42 		goto drop;
43 	if (team_dev_queue_xmit(team, active_port, skb))
44 		return false;
45 	return true;
46 
47 drop:
48 	dev_kfree_skb_any(skb);
49 	return false;
50 }
51 
ab_port_leave(struct team * team,struct team_port * port)52 static void ab_port_leave(struct team *team, struct team_port *port)
53 {
54 	if (ab_priv(team)->active_port == port) {
55 		RCU_INIT_POINTER(ab_priv(team)->active_port, NULL);
56 		team_option_inst_set_change(ab_priv(team)->ap_opt_inst_info);
57 	}
58 }
59 
ab_active_port_init(struct team * team,struct team_option_inst_info * info)60 static int ab_active_port_init(struct team *team,
61 			       struct team_option_inst_info *info)
62 {
63 	ab_priv(team)->ap_opt_inst_info = info;
64 	return 0;
65 }
66 
ab_active_port_get(struct team * team,struct team_gsetter_ctx * ctx)67 static int ab_active_port_get(struct team *team, struct team_gsetter_ctx *ctx)
68 {
69 	struct team_port *active_port;
70 
71 	active_port = rcu_dereference_protected(ab_priv(team)->active_port,
72 						lockdep_is_held(&team->lock));
73 	if (active_port)
74 		ctx->data.u32_val = active_port->dev->ifindex;
75 	else
76 		ctx->data.u32_val = 0;
77 	return 0;
78 }
79 
ab_active_port_set(struct team * team,struct team_gsetter_ctx * ctx)80 static int ab_active_port_set(struct team *team, struct team_gsetter_ctx *ctx)
81 {
82 	struct team_port *port;
83 
84 	list_for_each_entry(port, &team->port_list, list) {
85 		if (port->dev->ifindex == ctx->data.u32_val) {
86 			rcu_assign_pointer(ab_priv(team)->active_port, port);
87 			return 0;
88 		}
89 	}
90 	return -ENOENT;
91 }
92 
93 static const struct team_option ab_options[] = {
94 	{
95 		.name = "activeport",
96 		.type = TEAM_OPTION_TYPE_U32,
97 		.init = ab_active_port_init,
98 		.getter = ab_active_port_get,
99 		.setter = ab_active_port_set,
100 	},
101 };
102 
ab_init(struct team * team)103 static int ab_init(struct team *team)
104 {
105 	return team_options_register(team, ab_options, ARRAY_SIZE(ab_options));
106 }
107 
ab_exit(struct team * team)108 static void ab_exit(struct team *team)
109 {
110 	team_options_unregister(team, ab_options, ARRAY_SIZE(ab_options));
111 }
112 
113 static const struct team_mode_ops ab_mode_ops = {
114 	.init			= ab_init,
115 	.exit			= ab_exit,
116 	.receive		= ab_receive,
117 	.transmit		= ab_transmit,
118 	.port_leave		= ab_port_leave,
119 };
120 
121 static const struct team_mode ab_mode = {
122 	.kind		= "activebackup",
123 	.owner		= THIS_MODULE,
124 	.priv_size	= sizeof(struct ab_priv),
125 	.ops		= &ab_mode_ops,
126 	.lag_tx_type	= NETDEV_LAG_TX_TYPE_ACTIVEBACKUP,
127 };
128 
ab_init_module(void)129 static int __init ab_init_module(void)
130 {
131 	return team_mode_register(&ab_mode);
132 }
133 
ab_cleanup_module(void)134 static void __exit ab_cleanup_module(void)
135 {
136 	team_mode_unregister(&ab_mode);
137 }
138 
139 module_init(ab_init_module);
140 module_exit(ab_cleanup_module);
141 
142 MODULE_LICENSE("GPL v2");
143 MODULE_AUTHOR("Jiri Pirko <jpirko@redhat.com>");
144 MODULE_DESCRIPTION("Active-backup mode for team");
145 MODULE_ALIAS_TEAM_MODE("activebackup");
146