forked from ~ljy/RK356X_SDK_RELEASE

hc
2023-12-11 072de836f53be56a70cecf70b43ae43b7ce17376
kernel/drivers/net/team/team.c
....@@ -1,11 +1,7 @@
1
+// SPDX-License-Identifier: GPL-2.0-or-later
12 /*
23 * drivers/net/team/team.c - Network team device driver
34 * 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.
95 */
106
117 #include <linux/kernel.h>
....@@ -28,7 +24,6 @@
2824 #include <net/genetlink.h>
2925 #include <net/netlink.h>
3026 #include <net/sch_generic.h>
31
-#include <net/switchdev.h>
3227 #include <generated/utsrelease.h>
3328 #include <linux/if_team.h>
3429
....@@ -39,13 +34,11 @@
3934 * Helpers
4035 **********/
4136
42
-#define team_port_exists(dev) (dev->priv_flags & IFF_TEAM_PORT)
43
-
4437 static struct team_port *team_port_get_rtnl(const struct net_device *dev)
4538 {
4639 struct team_port *port = rtnl_dereference(dev->rx_handler_data);
4740
48
- return team_port_exists(dev) ? port : NULL;
41
+ return netif_is_team_port(dev) ? port : NULL;
4942 }
5043
5144 /*
....@@ -59,7 +52,7 @@
5952
6053 memcpy(addr.__data, dev_addr, port_dev->addr_len);
6154 addr.ss_family = port_dev->type;
62
- return dev_set_mac_address(port_dev, (struct sockaddr *)&addr);
55
+ return dev_set_mac_address(port_dev, (struct sockaddr *)&addr, NULL);
6356 }
6457
6558 static int team_port_set_orig_dev_addr(struct team_port *port)
....@@ -1097,10 +1090,7 @@
10971090 return;
10981091 port->np = NULL;
10991092
1100
- /* Wait for transmitting packets to finish before freeing. */
1101
- synchronize_rcu_bh();
1102
- __netpoll_cleanup(np);
1103
- kfree(np);
1093
+ __netpoll_free(np);
11041094 }
11051095 #else
11061096 static int team_port_enable_netpoll(struct team_port *port)
....@@ -1153,7 +1143,7 @@
11531143 return -EINVAL;
11541144 }
11551145
1156
- if (team_port_exists(port_dev)) {
1146
+ if (netif_is_team_port(port_dev)) {
11571147 NL_SET_ERR_MSG(extack, "Device is already a port of a team device");
11581148 netdev_err(dev, "Device %s is already a port "
11591149 "of a team device\n", portname);
....@@ -1217,7 +1207,7 @@
12171207 goto err_port_enter;
12181208 }
12191209
1220
- err = dev_open(port_dev);
1210
+ err = dev_open(port_dev, extack);
12211211 if (err) {
12221212 netdev_dbg(dev, "Device %s opening failed\n",
12231213 portname);
....@@ -1280,10 +1270,12 @@
12801270 }
12811271 }
12821272
1283
- netif_addr_lock_bh(dev);
1284
- dev_uc_sync_multiple(port_dev, dev);
1285
- dev_mc_sync_multiple(port_dev, dev);
1286
- netif_addr_unlock_bh(dev);
1273
+ if (dev->flags & IFF_UP) {
1274
+ netif_addr_lock_bh(dev);
1275
+ dev_uc_sync_multiple(port_dev, dev);
1276
+ dev_mc_sync_multiple(port_dev, dev);
1277
+ netif_addr_unlock_bh(dev);
1278
+ }
12871279
12881280 port->index = -1;
12891281 list_add_tail_rcu(&port->list, &team->port_list);
....@@ -1354,8 +1346,10 @@
13541346 netdev_rx_handler_unregister(port_dev);
13551347 team_port_disable_netpoll(port);
13561348 vlan_vids_del_by_dev(port_dev, dev);
1357
- dev_uc_unsync(port_dev, dev);
1358
- dev_mc_unsync(port_dev, dev);
1349
+ if (dev->flags & IFF_UP) {
1350
+ dev_uc_unsync(port_dev, dev);
1351
+ dev_mc_unsync(port_dev, dev);
1352
+ }
13591353 dev_close(port_dev);
13601354 team_port_leave(team, port);
13611355
....@@ -1629,7 +1623,6 @@
16291623 int err;
16301624
16311625 team->dev = dev;
1632
- mutex_init(&team->lock);
16331626 team_set_no_mode(team);
16341627
16351628 team->pcpu_stats = netdev_alloc_pcpu_stats(struct team_pcpu_stats);
....@@ -1656,6 +1649,8 @@
16561649 goto err_options_register;
16571650 netif_carrier_off(dev);
16581651
1652
+ lockdep_register_key(&team->team_lock_key);
1653
+ __mutex_init(&team->lock, "team->team_lock_key", &team->team_lock_key);
16591654 netdev_lockdep_set_classes(dev);
16601655
16611656 return 0;
....@@ -1687,6 +1682,7 @@
16871682 team_queue_override_fini(team);
16881683 mutex_unlock(&team->lock);
16891684 netdev_change_features(dev);
1685
+ lockdep_unregister_key(&team->team_lock_key);
16901686 }
16911687
16921688 static void team_destructor(struct net_device *dev)
....@@ -1703,6 +1699,14 @@
17031699
17041700 static int team_close(struct net_device *dev)
17051701 {
1702
+ struct team *team = netdev_priv(dev);
1703
+ struct team_port *port;
1704
+
1705
+ list_for_each_entry(port, &team->port_list, list) {
1706
+ dev_uc_unsync(port->dev, dev);
1707
+ dev_mc_unsync(port->dev, dev);
1708
+ }
1709
+
17061710 return 0;
17071711 }
17081712
....@@ -1734,8 +1738,7 @@
17341738 }
17351739
17361740 static u16 team_select_queue(struct net_device *dev, struct sk_buff *skb,
1737
- struct net_device *sb_dev,
1738
- select_queue_fallback_t fallback)
1741
+ struct net_device *sb_dev)
17391742 {
17401743 /*
17411744 * This helper function exists to help dev_pick_tx get the correct
....@@ -1991,8 +1994,15 @@
19911994 err = team_port_del(team, port_dev);
19921995 mutex_unlock(&team->lock);
19931996
1994
- if (!err)
1995
- netdev_change_features(dev);
1997
+ if (err)
1998
+ return err;
1999
+
2000
+ if (netif_is_team_master(port_dev)) {
2001
+ lockdep_unregister_key(&team->team_lock_key);
2002
+ lockdep_register_key(&team->team_lock_key);
2003
+ lockdep_set_class(&team->lock, &team->team_lock_key);
2004
+ }
2005
+ netdev_change_features(dev);
19962006
19972007 return err;
19982008 }
....@@ -2071,9 +2081,37 @@
20712081 strlcpy(drvinfo->version, UTS_RELEASE, sizeof(drvinfo->version));
20722082 }
20732083
2084
+static int team_ethtool_get_link_ksettings(struct net_device *dev,
2085
+ struct ethtool_link_ksettings *cmd)
2086
+{
2087
+ struct team *team= netdev_priv(dev);
2088
+ unsigned long speed = 0;
2089
+ struct team_port *port;
2090
+
2091
+ cmd->base.duplex = DUPLEX_UNKNOWN;
2092
+ cmd->base.port = PORT_OTHER;
2093
+
2094
+ rcu_read_lock();
2095
+ list_for_each_entry_rcu(port, &team->port_list, list) {
2096
+ if (team_port_txable(port)) {
2097
+ if (port->state.speed != SPEED_UNKNOWN)
2098
+ speed += port->state.speed;
2099
+ if (cmd->base.duplex == DUPLEX_UNKNOWN &&
2100
+ port->state.duplex != DUPLEX_UNKNOWN)
2101
+ cmd->base.duplex = port->state.duplex;
2102
+ }
2103
+ }
2104
+ rcu_read_unlock();
2105
+
2106
+ cmd->base.speed = speed ? : SPEED_UNKNOWN;
2107
+
2108
+ return 0;
2109
+}
2110
+
20742111 static const struct ethtool_ops team_ethtool_ops = {
20752112 .get_drvinfo = team_ethtool_get_drvinfo,
20762113 .get_link = ethtool_op_get_link,
2114
+ .get_link_ksettings = team_ethtool_get_link_ksettings,
20772115 };
20782116
20792117 /***********************
....@@ -2306,7 +2344,7 @@
23062344 if (err)
23072345 return err;
23082346
2309
- option_item = nla_nest_start(skb, TEAM_ATTR_ITEM_OPTION);
2347
+ option_item = nla_nest_start_noflag(skb, TEAM_ATTR_ITEM_OPTION);
23102348 if (!option_item)
23112349 return -EMSGSIZE;
23122350
....@@ -2420,7 +2458,7 @@
24202458
24212459 if (nla_put_u32(skb, TEAM_ATTR_TEAM_IFINDEX, team->dev->ifindex))
24222460 goto nla_put_failure;
2423
- option_list = nla_nest_start(skb, TEAM_ATTR_LIST_OPTION);
2461
+ option_list = nla_nest_start_noflag(skb, TEAM_ATTR_LIST_OPTION);
24242462 if (!option_list)
24252463 goto nla_put_failure;
24262464
....@@ -2526,9 +2564,11 @@
25262564 err = -EINVAL;
25272565 goto team_put;
25282566 }
2529
- err = nla_parse_nested(opt_attrs, TEAM_ATTR_OPTION_MAX,
2530
- nl_option, team_nl_option_policy,
2531
- info->extack);
2567
+ err = nla_parse_nested_deprecated(opt_attrs,
2568
+ TEAM_ATTR_OPTION_MAX,
2569
+ nl_option,
2570
+ team_nl_option_policy,
2571
+ info->extack);
25322572 if (err)
25332573 goto team_put;
25342574 if (!opt_attrs[TEAM_ATTR_OPTION_NAME] ||
....@@ -2642,7 +2682,7 @@
26422682 {
26432683 struct nlattr *port_item;
26442684
2645
- port_item = nla_nest_start(skb, TEAM_ATTR_ITEM_PORT);
2685
+ port_item = nla_nest_start_noflag(skb, TEAM_ATTR_ITEM_PORT);
26462686 if (!port_item)
26472687 goto nest_cancel;
26482688 if (nla_put_u32(skb, TEAM_ATTR_PORT_IFINDEX, port->dev->ifindex))
....@@ -2697,7 +2737,7 @@
26972737
26982738 if (nla_put_u32(skb, TEAM_ATTR_TEAM_IFINDEX, team->dev->ifindex))
26992739 goto nla_put_failure;
2700
- port_list = nla_nest_start(skb, TEAM_ATTR_LIST_PORT);
2740
+ port_list = nla_nest_start_noflag(skb, TEAM_ATTR_LIST_PORT);
27012741 if (!port_list)
27022742 goto nla_put_failure;
27032743
....@@ -2768,28 +2808,28 @@
27682808 return err;
27692809 }
27702810
2771
-static const struct genl_ops team_nl_ops[] = {
2811
+static const struct genl_small_ops team_nl_ops[] = {
27722812 {
27732813 .cmd = TEAM_CMD_NOOP,
2814
+ .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
27742815 .doit = team_nl_cmd_noop,
2775
- .policy = team_nl_policy,
27762816 },
27772817 {
27782818 .cmd = TEAM_CMD_OPTIONS_SET,
2819
+ .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
27792820 .doit = team_nl_cmd_options_set,
2780
- .policy = team_nl_policy,
27812821 .flags = GENL_ADMIN_PERM,
27822822 },
27832823 {
27842824 .cmd = TEAM_CMD_OPTIONS_GET,
2825
+ .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
27852826 .doit = team_nl_cmd_options_get,
2786
- .policy = team_nl_policy,
27872827 .flags = GENL_ADMIN_PERM,
27882828 },
27892829 {
27902830 .cmd = TEAM_CMD_PORT_LIST_GET,
2831
+ .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
27912832 .doit = team_nl_cmd_port_list_get,
2792
- .policy = team_nl_policy,
27932833 .flags = GENL_ADMIN_PERM,
27942834 },
27952835 };
....@@ -2802,10 +2842,11 @@
28022842 .name = TEAM_GENL_NAME,
28032843 .version = TEAM_GENL_VERSION,
28042844 .maxattr = TEAM_ATTR_MAX,
2845
+ .policy = team_nl_policy,
28052846 .netnsok = true,
28062847 .module = THIS_MODULE,
2807
- .ops = team_nl_ops,
2808
- .n_ops = ARRAY_SIZE(team_nl_ops),
2848
+ .small_ops = team_nl_ops,
2849
+ .n_small_ops = ARRAY_SIZE(team_nl_ops),
28092850 .mcgrps = team_nl_mcgrps,
28102851 .n_mcgrps = ARRAY_SIZE(team_nl_mcgrps),
28112852 };