team: introduce two default team_modeop functions and use them in modes
[firefly-linux-kernel-4.4.55.git] / drivers / net / team / team_mode_roundrobin.c
1 /*
2  * drivers/net/team/team_mode_roundrobin.c - Round-robin mode for team
3  * Copyright (c) 2011 Jiri Pirko <jpirko@redhat.com>
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  */
10
11 #include <linux/kernel.h>
12 #include <linux/types.h>
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/errno.h>
16 #include <linux/netdevice.h>
17 #include <linux/if_team.h>
18
19 struct rr_priv {
20         unsigned int sent_packets;
21 };
22
23 static struct rr_priv *rr_priv(struct team *team)
24 {
25         return (struct rr_priv *) &team->mode_priv;
26 }
27
28 static struct team_port *__get_first_port_up(struct team *team,
29                                              struct team_port *port)
30 {
31         struct team_port *cur;
32
33         if (team_port_txable(port))
34                 return port;
35         cur = port;
36         list_for_each_entry_continue_rcu(cur, &team->port_list, list)
37                 if (team_port_txable(port))
38                         return cur;
39         list_for_each_entry_rcu(cur, &team->port_list, list) {
40                 if (cur == port)
41                         break;
42                 if (team_port_txable(port))
43                         return cur;
44         }
45         return NULL;
46 }
47
48 static bool rr_transmit(struct team *team, struct sk_buff *skb)
49 {
50         struct team_port *port;
51         int port_index;
52
53         port_index = rr_priv(team)->sent_packets++ % team->en_port_count;
54         port = team_get_port_by_index_rcu(team, port_index);
55         port = __get_first_port_up(team, port);
56         if (unlikely(!port))
57                 goto drop;
58         if (team_dev_queue_xmit(team, port, skb))
59                 return false;
60         return true;
61
62 drop:
63         dev_kfree_skb_any(skb);
64         return false;
65 }
66
67 static const struct team_mode_ops rr_mode_ops = {
68         .transmit               = rr_transmit,
69         .port_enter             = team_modeop_port_enter,
70         .port_change_dev_addr   = team_modeop_port_change_dev_addr,
71 };
72
73 static const struct team_mode rr_mode = {
74         .kind           = "roundrobin",
75         .owner          = THIS_MODULE,
76         .priv_size      = sizeof(struct rr_priv),
77         .ops            = &rr_mode_ops,
78 };
79
80 static int __init rr_init_module(void)
81 {
82         return team_mode_register(&rr_mode);
83 }
84
85 static void __exit rr_cleanup_module(void)
86 {
87         team_mode_unregister(&rr_mode);
88 }
89
90 module_init(rr_init_module);
91 module_exit(rr_cleanup_module);
92
93 MODULE_LICENSE("GPL v2");
94 MODULE_AUTHOR("Jiri Pirko <jpirko@redhat.com>");
95 MODULE_DESCRIPTION("Round-robin mode for team");
96 MODULE_ALIAS("team-mode-roundrobin");