1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * net/core/ethtool.c - Ethtool ioctl handler
4 * Copyright (c) 2003 Matthew Wilcox <matthew@wil.cx>
6 * This file is where we call all the ethtool_ops commands to get
7 * the information ethtool needs.
10 #include <linux/module.h>
11 #include <linux/types.h>
12 #include <linux/capability.h>
13 #include <linux/errno.h>
14 #include <linux/ethtool.h>
15 #include <linux/netdevice.h>
16 #include <linux/net_tstamp.h>
17 #include <linux/phy.h>
18 #include <linux/bitops.h>
19 #include <linux/uaccess.h>
20 #include <linux/vmalloc.h>
21 #include <linux/sfp.h>
22 #include <linux/slab.h>
23 #include <linux/rtnetlink.h>
24 #include <linux/sched/signal.h>
25 #include <linux/net.h>
26 #include <net/devlink.h>
27 #include <net/xdp_sock.h>
28 #include <net/flow_offload.h>
31 * Some useful ethtool_ops methods that're device independent.
32 * If we find that all drivers want to do the same thing here,
33 * we can turn these into dev_() function calls.
36 u32
ethtool_op_get_link(struct net_device
*dev
)
38 return netif_carrier_ok(dev
) ? 1 : 0;
40 EXPORT_SYMBOL(ethtool_op_get_link
);
42 int ethtool_op_get_ts_info(struct net_device
*dev
, struct ethtool_ts_info
*info
)
44 info
->so_timestamping
=
45 SOF_TIMESTAMPING_TX_SOFTWARE
|
46 SOF_TIMESTAMPING_RX_SOFTWARE
|
47 SOF_TIMESTAMPING_SOFTWARE
;
51 EXPORT_SYMBOL(ethtool_op_get_ts_info
);
53 /* Handlers for each ethtool command */
55 #define ETHTOOL_DEV_FEATURE_WORDS ((NETDEV_FEATURE_COUNT + 31) / 32)
57 static const char netdev_features_strings
[NETDEV_FEATURE_COUNT
][ETH_GSTRING_LEN
] = {
58 [NETIF_F_SG_BIT
] = "tx-scatter-gather",
59 [NETIF_F_IP_CSUM_BIT
] = "tx-checksum-ipv4",
60 [NETIF_F_HW_CSUM_BIT
] = "tx-checksum-ip-generic",
61 [NETIF_F_IPV6_CSUM_BIT
] = "tx-checksum-ipv6",
62 [NETIF_F_HIGHDMA_BIT
] = "highdma",
63 [NETIF_F_FRAGLIST_BIT
] = "tx-scatter-gather-fraglist",
64 [NETIF_F_HW_VLAN_CTAG_TX_BIT
] = "tx-vlan-hw-insert",
66 [NETIF_F_HW_VLAN_CTAG_RX_BIT
] = "rx-vlan-hw-parse",
67 [NETIF_F_HW_VLAN_CTAG_FILTER_BIT
] = "rx-vlan-filter",
68 [NETIF_F_HW_VLAN_STAG_TX_BIT
] = "tx-vlan-stag-hw-insert",
69 [NETIF_F_HW_VLAN_STAG_RX_BIT
] = "rx-vlan-stag-hw-parse",
70 [NETIF_F_HW_VLAN_STAG_FILTER_BIT
] = "rx-vlan-stag-filter",
71 [NETIF_F_VLAN_CHALLENGED_BIT
] = "vlan-challenged",
72 [NETIF_F_GSO_BIT
] = "tx-generic-segmentation",
73 [NETIF_F_LLTX_BIT
] = "tx-lockless",
74 [NETIF_F_NETNS_LOCAL_BIT
] = "netns-local",
75 [NETIF_F_GRO_BIT
] = "rx-gro",
76 [NETIF_F_GRO_HW_BIT
] = "rx-gro-hw",
77 [NETIF_F_LRO_BIT
] = "rx-lro",
79 [NETIF_F_TSO_BIT
] = "tx-tcp-segmentation",
80 [NETIF_F_GSO_ROBUST_BIT
] = "tx-gso-robust",
81 [NETIF_F_TSO_ECN_BIT
] = "tx-tcp-ecn-segmentation",
82 [NETIF_F_TSO_MANGLEID_BIT
] = "tx-tcp-mangleid-segmentation",
83 [NETIF_F_TSO6_BIT
] = "tx-tcp6-segmentation",
84 [NETIF_F_FSO_BIT
] = "tx-fcoe-segmentation",
85 [NETIF_F_GSO_GRE_BIT
] = "tx-gre-segmentation",
86 [NETIF_F_GSO_GRE_CSUM_BIT
] = "tx-gre-csum-segmentation",
87 [NETIF_F_GSO_IPXIP4_BIT
] = "tx-ipxip4-segmentation",
88 [NETIF_F_GSO_IPXIP6_BIT
] = "tx-ipxip6-segmentation",
89 [NETIF_F_GSO_UDP_TUNNEL_BIT
] = "tx-udp_tnl-segmentation",
90 [NETIF_F_GSO_UDP_TUNNEL_CSUM_BIT
] = "tx-udp_tnl-csum-segmentation",
91 [NETIF_F_GSO_PARTIAL_BIT
] = "tx-gso-partial",
92 [NETIF_F_GSO_SCTP_BIT
] = "tx-sctp-segmentation",
93 [NETIF_F_GSO_ESP_BIT
] = "tx-esp-segmentation",
94 [NETIF_F_GSO_UDP_L4_BIT
] = "tx-udp-segmentation",
96 [NETIF_F_FCOE_CRC_BIT
] = "tx-checksum-fcoe-crc",
97 [NETIF_F_SCTP_CRC_BIT
] = "tx-checksum-sctp",
98 [NETIF_F_FCOE_MTU_BIT
] = "fcoe-mtu",
99 [NETIF_F_NTUPLE_BIT
] = "rx-ntuple-filter",
100 [NETIF_F_RXHASH_BIT
] = "rx-hashing",
101 [NETIF_F_RXCSUM_BIT
] = "rx-checksum",
102 [NETIF_F_NOCACHE_COPY_BIT
] = "tx-nocache-copy",
103 [NETIF_F_LOOPBACK_BIT
] = "loopback",
104 [NETIF_F_RXFCS_BIT
] = "rx-fcs",
105 [NETIF_F_RXALL_BIT
] = "rx-all",
106 [NETIF_F_HW_L2FW_DOFFLOAD_BIT
] = "l2-fwd-offload",
107 [NETIF_F_HW_TC_BIT
] = "hw-tc-offload",
108 [NETIF_F_HW_ESP_BIT
] = "esp-hw-offload",
109 [NETIF_F_HW_ESP_TX_CSUM_BIT
] = "esp-tx-csum-hw-offload",
110 [NETIF_F_RX_UDP_TUNNEL_PORT_BIT
] = "rx-udp_tunnel-port-offload",
111 [NETIF_F_HW_TLS_RECORD_BIT
] = "tls-hw-record",
112 [NETIF_F_HW_TLS_TX_BIT
] = "tls-hw-tx-offload",
113 [NETIF_F_HW_TLS_RX_BIT
] = "tls-hw-rx-offload",
117 rss_hash_func_strings
[ETH_RSS_HASH_FUNCS_COUNT
][ETH_GSTRING_LEN
] = {
118 [ETH_RSS_HASH_TOP_BIT
] = "toeplitz",
119 [ETH_RSS_HASH_XOR_BIT
] = "xor",
120 [ETH_RSS_HASH_CRC32_BIT
] = "crc32",
124 tunable_strings
[__ETHTOOL_TUNABLE_COUNT
][ETH_GSTRING_LEN
] = {
125 [ETHTOOL_ID_UNSPEC
] = "Unspec",
126 [ETHTOOL_RX_COPYBREAK
] = "rx-copybreak",
127 [ETHTOOL_TX_COPYBREAK
] = "tx-copybreak",
128 [ETHTOOL_PFC_PREVENTION_TOUT
] = "pfc-prevention-tout",
132 phy_tunable_strings
[__ETHTOOL_PHY_TUNABLE_COUNT
][ETH_GSTRING_LEN
] = {
133 [ETHTOOL_ID_UNSPEC
] = "Unspec",
134 [ETHTOOL_PHY_DOWNSHIFT
] = "phy-downshift",
135 [ETHTOOL_PHY_FAST_LINK_DOWN
] = "phy-fast-link-down",
136 [ETHTOOL_PHY_EDPD
] = "phy-energy-detect-power-down",
139 static int ethtool_get_features(struct net_device
*dev
, void __user
*useraddr
)
141 struct ethtool_gfeatures cmd
= {
142 .cmd
= ETHTOOL_GFEATURES
,
143 .size
= ETHTOOL_DEV_FEATURE_WORDS
,
145 struct ethtool_get_features_block features
[ETHTOOL_DEV_FEATURE_WORDS
];
146 u32 __user
*sizeaddr
;
150 /* in case feature bits run out again */
151 BUILD_BUG_ON(ETHTOOL_DEV_FEATURE_WORDS
* sizeof(u32
) > sizeof(netdev_features_t
));
153 for (i
= 0; i
< ETHTOOL_DEV_FEATURE_WORDS
; ++i
) {
154 features
[i
].available
= (u32
)(dev
->hw_features
>> (32 * i
));
155 features
[i
].requested
= (u32
)(dev
->wanted_features
>> (32 * i
));
156 features
[i
].active
= (u32
)(dev
->features
>> (32 * i
));
157 features
[i
].never_changed
=
158 (u32
)(NETIF_F_NEVER_CHANGE
>> (32 * i
));
161 sizeaddr
= useraddr
+ offsetof(struct ethtool_gfeatures
, size
);
162 if (get_user(copy_size
, sizeaddr
))
165 if (copy_size
> ETHTOOL_DEV_FEATURE_WORDS
)
166 copy_size
= ETHTOOL_DEV_FEATURE_WORDS
;
168 if (copy_to_user(useraddr
, &cmd
, sizeof(cmd
)))
170 useraddr
+= sizeof(cmd
);
171 if (copy_to_user(useraddr
, features
, copy_size
* sizeof(*features
)))
177 static int ethtool_set_features(struct net_device
*dev
, void __user
*useraddr
)
179 struct ethtool_sfeatures cmd
;
180 struct ethtool_set_features_block features
[ETHTOOL_DEV_FEATURE_WORDS
];
181 netdev_features_t wanted
= 0, valid
= 0;
184 if (copy_from_user(&cmd
, useraddr
, sizeof(cmd
)))
186 useraddr
+= sizeof(cmd
);
188 if (cmd
.size
!= ETHTOOL_DEV_FEATURE_WORDS
)
191 if (copy_from_user(features
, useraddr
, sizeof(features
)))
194 for (i
= 0; i
< ETHTOOL_DEV_FEATURE_WORDS
; ++i
) {
195 valid
|= (netdev_features_t
)features
[i
].valid
<< (32 * i
);
196 wanted
|= (netdev_features_t
)features
[i
].requested
<< (32 * i
);
199 if (valid
& ~NETIF_F_ETHTOOL_BITS
)
202 if (valid
& ~dev
->hw_features
) {
203 valid
&= dev
->hw_features
;
204 ret
|= ETHTOOL_F_UNSUPPORTED
;
207 dev
->wanted_features
&= ~valid
;
208 dev
->wanted_features
|= wanted
& valid
;
209 __netdev_update_features(dev
);
211 if ((dev
->wanted_features
^ dev
->features
) & valid
)
212 ret
|= ETHTOOL_F_WISH
;
217 static int __ethtool_get_sset_count(struct net_device
*dev
, int sset
)
219 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
221 if (sset
== ETH_SS_FEATURES
)
222 return ARRAY_SIZE(netdev_features_strings
);
224 if (sset
== ETH_SS_RSS_HASH_FUNCS
)
225 return ARRAY_SIZE(rss_hash_func_strings
);
227 if (sset
== ETH_SS_TUNABLES
)
228 return ARRAY_SIZE(tunable_strings
);
230 if (sset
== ETH_SS_PHY_TUNABLES
)
231 return ARRAY_SIZE(phy_tunable_strings
);
233 if (sset
== ETH_SS_PHY_STATS
&& dev
->phydev
&&
234 !ops
->get_ethtool_phy_stats
)
235 return phy_ethtool_get_sset_count(dev
->phydev
);
237 if (ops
->get_sset_count
&& ops
->get_strings
)
238 return ops
->get_sset_count(dev
, sset
);
243 static void __ethtool_get_strings(struct net_device
*dev
,
244 u32 stringset
, u8
*data
)
246 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
248 if (stringset
== ETH_SS_FEATURES
)
249 memcpy(data
, netdev_features_strings
,
250 sizeof(netdev_features_strings
));
251 else if (stringset
== ETH_SS_RSS_HASH_FUNCS
)
252 memcpy(data
, rss_hash_func_strings
,
253 sizeof(rss_hash_func_strings
));
254 else if (stringset
== ETH_SS_TUNABLES
)
255 memcpy(data
, tunable_strings
, sizeof(tunable_strings
));
256 else if (stringset
== ETH_SS_PHY_TUNABLES
)
257 memcpy(data
, phy_tunable_strings
, sizeof(phy_tunable_strings
));
258 else if (stringset
== ETH_SS_PHY_STATS
&& dev
->phydev
&&
259 !ops
->get_ethtool_phy_stats
)
260 phy_ethtool_get_strings(dev
->phydev
, data
);
262 /* ops->get_strings is valid because checked earlier */
263 ops
->get_strings(dev
, stringset
, data
);
266 static netdev_features_t
ethtool_get_feature_mask(u32 eth_cmd
)
268 /* feature masks of legacy discrete ethtool ops */
271 case ETHTOOL_GTXCSUM
:
272 case ETHTOOL_STXCSUM
:
273 return NETIF_F_CSUM_MASK
| NETIF_F_SCTP_CRC
;
274 case ETHTOOL_GRXCSUM
:
275 case ETHTOOL_SRXCSUM
:
276 return NETIF_F_RXCSUM
;
282 return NETIF_F_ALL_TSO
;
294 static int ethtool_get_one_feature(struct net_device
*dev
,
295 char __user
*useraddr
, u32 ethcmd
)
297 netdev_features_t mask
= ethtool_get_feature_mask(ethcmd
);
298 struct ethtool_value edata
= {
300 .data
= !!(dev
->features
& mask
),
303 if (copy_to_user(useraddr
, &edata
, sizeof(edata
)))
308 static int ethtool_set_one_feature(struct net_device
*dev
,
309 void __user
*useraddr
, u32 ethcmd
)
311 struct ethtool_value edata
;
312 netdev_features_t mask
;
314 if (copy_from_user(&edata
, useraddr
, sizeof(edata
)))
317 mask
= ethtool_get_feature_mask(ethcmd
);
318 mask
&= dev
->hw_features
;
323 dev
->wanted_features
|= mask
;
325 dev
->wanted_features
&= ~mask
;
327 __netdev_update_features(dev
);
332 #define ETH_ALL_FLAGS (ETH_FLAG_LRO | ETH_FLAG_RXVLAN | ETH_FLAG_TXVLAN | \
333 ETH_FLAG_NTUPLE | ETH_FLAG_RXHASH)
334 #define ETH_ALL_FEATURES (NETIF_F_LRO | NETIF_F_HW_VLAN_CTAG_RX | \
335 NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_NTUPLE | \
338 static u32
__ethtool_get_flags(struct net_device
*dev
)
342 if (dev
->features
& NETIF_F_LRO
)
343 flags
|= ETH_FLAG_LRO
;
344 if (dev
->features
& NETIF_F_HW_VLAN_CTAG_RX
)
345 flags
|= ETH_FLAG_RXVLAN
;
346 if (dev
->features
& NETIF_F_HW_VLAN_CTAG_TX
)
347 flags
|= ETH_FLAG_TXVLAN
;
348 if (dev
->features
& NETIF_F_NTUPLE
)
349 flags
|= ETH_FLAG_NTUPLE
;
350 if (dev
->features
& NETIF_F_RXHASH
)
351 flags
|= ETH_FLAG_RXHASH
;
356 static int __ethtool_set_flags(struct net_device
*dev
, u32 data
)
358 netdev_features_t features
= 0, changed
;
360 if (data
& ~ETH_ALL_FLAGS
)
363 if (data
& ETH_FLAG_LRO
)
364 features
|= NETIF_F_LRO
;
365 if (data
& ETH_FLAG_RXVLAN
)
366 features
|= NETIF_F_HW_VLAN_CTAG_RX
;
367 if (data
& ETH_FLAG_TXVLAN
)
368 features
|= NETIF_F_HW_VLAN_CTAG_TX
;
369 if (data
& ETH_FLAG_NTUPLE
)
370 features
|= NETIF_F_NTUPLE
;
371 if (data
& ETH_FLAG_RXHASH
)
372 features
|= NETIF_F_RXHASH
;
374 /* allow changing only bits set in hw_features */
375 changed
= (features
^ dev
->features
) & ETH_ALL_FEATURES
;
376 if (changed
& ~dev
->hw_features
)
377 return (changed
& dev
->hw_features
) ? -EINVAL
: -EOPNOTSUPP
;
379 dev
->wanted_features
=
380 (dev
->wanted_features
& ~changed
) | (features
& changed
);
382 __netdev_update_features(dev
);
387 /* Given two link masks, AND them together and save the result in dst. */
388 void ethtool_intersect_link_masks(struct ethtool_link_ksettings
*dst
,
389 struct ethtool_link_ksettings
*src
)
391 unsigned int size
= BITS_TO_LONGS(__ETHTOOL_LINK_MODE_MASK_NBITS
);
392 unsigned int idx
= 0;
394 for (; idx
< size
; idx
++) {
395 dst
->link_modes
.supported
[idx
] &=
396 src
->link_modes
.supported
[idx
];
397 dst
->link_modes
.advertising
[idx
] &=
398 src
->link_modes
.advertising
[idx
];
401 EXPORT_SYMBOL(ethtool_intersect_link_masks
);
403 void ethtool_convert_legacy_u32_to_link_mode(unsigned long *dst
,
406 bitmap_zero(dst
, __ETHTOOL_LINK_MODE_MASK_NBITS
);
409 EXPORT_SYMBOL(ethtool_convert_legacy_u32_to_link_mode
);
411 /* return false if src had higher bits set. lower bits always updated. */
412 bool ethtool_convert_link_mode_to_legacy_u32(u32
*legacy_u32
,
413 const unsigned long *src
)
417 /* TODO: following test will soon always be true */
418 if (__ETHTOOL_LINK_MODE_MASK_NBITS
> 32) {
419 __ETHTOOL_DECLARE_LINK_MODE_MASK(ext
);
421 bitmap_zero(ext
, __ETHTOOL_LINK_MODE_MASK_NBITS
);
422 bitmap_fill(ext
, 32);
423 bitmap_complement(ext
, ext
, __ETHTOOL_LINK_MODE_MASK_NBITS
);
424 if (bitmap_intersects(ext
, src
,
425 __ETHTOOL_LINK_MODE_MASK_NBITS
)) {
426 /* src mask goes beyond bit 31 */
430 *legacy_u32
= src
[0];
433 EXPORT_SYMBOL(ethtool_convert_link_mode_to_legacy_u32
);
435 /* return false if legacy contained non-0 deprecated fields
436 * maxtxpkt/maxrxpkt. rest of ksettings always updated
439 convert_legacy_settings_to_link_ksettings(
440 struct ethtool_link_ksettings
*link_ksettings
,
441 const struct ethtool_cmd
*legacy_settings
)
445 memset(link_ksettings
, 0, sizeof(*link_ksettings
));
447 /* This is used to tell users that driver is still using these
448 * deprecated legacy fields, and they should not use
449 * %ETHTOOL_GLINKSETTINGS/%ETHTOOL_SLINKSETTINGS
451 if (legacy_settings
->maxtxpkt
||
452 legacy_settings
->maxrxpkt
)
455 ethtool_convert_legacy_u32_to_link_mode(
456 link_ksettings
->link_modes
.supported
,
457 legacy_settings
->supported
);
458 ethtool_convert_legacy_u32_to_link_mode(
459 link_ksettings
->link_modes
.advertising
,
460 legacy_settings
->advertising
);
461 ethtool_convert_legacy_u32_to_link_mode(
462 link_ksettings
->link_modes
.lp_advertising
,
463 legacy_settings
->lp_advertising
);
464 link_ksettings
->base
.speed
465 = ethtool_cmd_speed(legacy_settings
);
466 link_ksettings
->base
.duplex
467 = legacy_settings
->duplex
;
468 link_ksettings
->base
.port
469 = legacy_settings
->port
;
470 link_ksettings
->base
.phy_address
471 = legacy_settings
->phy_address
;
472 link_ksettings
->base
.autoneg
473 = legacy_settings
->autoneg
;
474 link_ksettings
->base
.mdio_support
475 = legacy_settings
->mdio_support
;
476 link_ksettings
->base
.eth_tp_mdix
477 = legacy_settings
->eth_tp_mdix
;
478 link_ksettings
->base
.eth_tp_mdix_ctrl
479 = legacy_settings
->eth_tp_mdix_ctrl
;
483 /* return false if ksettings link modes had higher bits
484 * set. legacy_settings always updated (best effort)
487 convert_link_ksettings_to_legacy_settings(
488 struct ethtool_cmd
*legacy_settings
,
489 const struct ethtool_link_ksettings
*link_ksettings
)
493 memset(legacy_settings
, 0, sizeof(*legacy_settings
));
494 /* this also clears the deprecated fields in legacy structure:
500 retval
&= ethtool_convert_link_mode_to_legacy_u32(
501 &legacy_settings
->supported
,
502 link_ksettings
->link_modes
.supported
);
503 retval
&= ethtool_convert_link_mode_to_legacy_u32(
504 &legacy_settings
->advertising
,
505 link_ksettings
->link_modes
.advertising
);
506 retval
&= ethtool_convert_link_mode_to_legacy_u32(
507 &legacy_settings
->lp_advertising
,
508 link_ksettings
->link_modes
.lp_advertising
);
509 ethtool_cmd_speed_set(legacy_settings
, link_ksettings
->base
.speed
);
510 legacy_settings
->duplex
511 = link_ksettings
->base
.duplex
;
512 legacy_settings
->port
513 = link_ksettings
->base
.port
;
514 legacy_settings
->phy_address
515 = link_ksettings
->base
.phy_address
;
516 legacy_settings
->autoneg
517 = link_ksettings
->base
.autoneg
;
518 legacy_settings
->mdio_support
519 = link_ksettings
->base
.mdio_support
;
520 legacy_settings
->eth_tp_mdix
521 = link_ksettings
->base
.eth_tp_mdix
;
522 legacy_settings
->eth_tp_mdix_ctrl
523 = link_ksettings
->base
.eth_tp_mdix_ctrl
;
524 legacy_settings
->transceiver
525 = link_ksettings
->base
.transceiver
;
529 /* number of 32-bit words to store the user's link mode bitmaps */
530 #define __ETHTOOL_LINK_MODE_MASK_NU32 \
531 DIV_ROUND_UP(__ETHTOOL_LINK_MODE_MASK_NBITS, 32)
533 /* layout of the struct passed from/to userland */
534 struct ethtool_link_usettings
{
535 struct ethtool_link_settings base
;
537 __u32 supported
[__ETHTOOL_LINK_MODE_MASK_NU32
];
538 __u32 advertising
[__ETHTOOL_LINK_MODE_MASK_NU32
];
539 __u32 lp_advertising
[__ETHTOOL_LINK_MODE_MASK_NU32
];
543 /* Internal kernel helper to query a device ethtool_link_settings. */
544 int __ethtool_get_link_ksettings(struct net_device
*dev
,
545 struct ethtool_link_ksettings
*link_ksettings
)
549 if (!dev
->ethtool_ops
->get_link_ksettings
)
552 memset(link_ksettings
, 0, sizeof(*link_ksettings
));
553 return dev
->ethtool_ops
->get_link_ksettings(dev
, link_ksettings
);
555 EXPORT_SYMBOL(__ethtool_get_link_ksettings
);
557 /* convert ethtool_link_usettings in user space to a kernel internal
558 * ethtool_link_ksettings. return 0 on success, errno on error.
560 static int load_link_ksettings_from_user(struct ethtool_link_ksettings
*to
,
561 const void __user
*from
)
563 struct ethtool_link_usettings link_usettings
;
565 if (copy_from_user(&link_usettings
, from
, sizeof(link_usettings
)))
568 memcpy(&to
->base
, &link_usettings
.base
, sizeof(to
->base
));
569 bitmap_from_arr32(to
->link_modes
.supported
,
570 link_usettings
.link_modes
.supported
,
571 __ETHTOOL_LINK_MODE_MASK_NBITS
);
572 bitmap_from_arr32(to
->link_modes
.advertising
,
573 link_usettings
.link_modes
.advertising
,
574 __ETHTOOL_LINK_MODE_MASK_NBITS
);
575 bitmap_from_arr32(to
->link_modes
.lp_advertising
,
576 link_usettings
.link_modes
.lp_advertising
,
577 __ETHTOOL_LINK_MODE_MASK_NBITS
);
582 /* convert a kernel internal ethtool_link_ksettings to
583 * ethtool_link_usettings in user space. return 0 on success, errno on
587 store_link_ksettings_for_user(void __user
*to
,
588 const struct ethtool_link_ksettings
*from
)
590 struct ethtool_link_usettings link_usettings
;
592 memcpy(&link_usettings
.base
, &from
->base
, sizeof(link_usettings
));
593 bitmap_to_arr32(link_usettings
.link_modes
.supported
,
594 from
->link_modes
.supported
,
595 __ETHTOOL_LINK_MODE_MASK_NBITS
);
596 bitmap_to_arr32(link_usettings
.link_modes
.advertising
,
597 from
->link_modes
.advertising
,
598 __ETHTOOL_LINK_MODE_MASK_NBITS
);
599 bitmap_to_arr32(link_usettings
.link_modes
.lp_advertising
,
600 from
->link_modes
.lp_advertising
,
601 __ETHTOOL_LINK_MODE_MASK_NBITS
);
603 if (copy_to_user(to
, &link_usettings
, sizeof(link_usettings
)))
609 /* Query device for its ethtool_link_settings. */
610 static int ethtool_get_link_ksettings(struct net_device
*dev
,
611 void __user
*useraddr
)
614 struct ethtool_link_ksettings link_ksettings
;
617 if (!dev
->ethtool_ops
->get_link_ksettings
)
620 /* handle bitmap nbits handshake */
621 if (copy_from_user(&link_ksettings
.base
, useraddr
,
622 sizeof(link_ksettings
.base
)))
625 if (__ETHTOOL_LINK_MODE_MASK_NU32
626 != link_ksettings
.base
.link_mode_masks_nwords
) {
627 /* wrong link mode nbits requested */
628 memset(&link_ksettings
, 0, sizeof(link_ksettings
));
629 link_ksettings
.base
.cmd
= ETHTOOL_GLINKSETTINGS
;
630 /* send back number of words required as negative val */
631 compiletime_assert(__ETHTOOL_LINK_MODE_MASK_NU32
<= S8_MAX
,
632 "need too many bits for link modes!");
633 link_ksettings
.base
.link_mode_masks_nwords
634 = -((s8
)__ETHTOOL_LINK_MODE_MASK_NU32
);
636 /* copy the base fields back to user, not the link
639 if (copy_to_user(useraddr
, &link_ksettings
.base
,
640 sizeof(link_ksettings
.base
)))
646 /* handshake successful: user/kernel agree on
647 * link_mode_masks_nwords
650 memset(&link_ksettings
, 0, sizeof(link_ksettings
));
651 err
= dev
->ethtool_ops
->get_link_ksettings(dev
, &link_ksettings
);
655 /* make sure we tell the right values to user */
656 link_ksettings
.base
.cmd
= ETHTOOL_GLINKSETTINGS
;
657 link_ksettings
.base
.link_mode_masks_nwords
658 = __ETHTOOL_LINK_MODE_MASK_NU32
;
660 return store_link_ksettings_for_user(useraddr
, &link_ksettings
);
663 /* Update device ethtool_link_settings. */
664 static int ethtool_set_link_ksettings(struct net_device
*dev
,
665 void __user
*useraddr
)
668 struct ethtool_link_ksettings link_ksettings
;
672 if (!dev
->ethtool_ops
->set_link_ksettings
)
675 /* make sure nbits field has expected value */
676 if (copy_from_user(&link_ksettings
.base
, useraddr
,
677 sizeof(link_ksettings
.base
)))
680 if (__ETHTOOL_LINK_MODE_MASK_NU32
681 != link_ksettings
.base
.link_mode_masks_nwords
)
684 /* copy the whole structure, now that we know it has expected
687 err
= load_link_ksettings_from_user(&link_ksettings
, useraddr
);
691 /* re-check nwords field, just in case */
692 if (__ETHTOOL_LINK_MODE_MASK_NU32
693 != link_ksettings
.base
.link_mode_masks_nwords
)
696 return dev
->ethtool_ops
->set_link_ksettings(dev
, &link_ksettings
);
699 /* Query device for its ethtool_cmd settings.
701 * Backward compatibility note: for compatibility with legacy ethtool, this is
702 * now implemented via get_link_ksettings. When driver reports higher link mode
703 * bits, a kernel warning is logged once (with name of 1st driver/device) to
704 * recommend user to upgrade ethtool, but the command is successful (only the
705 * lower link mode bits reported back to user). Deprecated fields from
706 * ethtool_cmd (transceiver/maxrxpkt/maxtxpkt) are always set to zero.
708 static int ethtool_get_settings(struct net_device
*dev
, void __user
*useraddr
)
710 struct ethtool_link_ksettings link_ksettings
;
711 struct ethtool_cmd cmd
;
715 if (!dev
->ethtool_ops
->get_link_ksettings
)
718 memset(&link_ksettings
, 0, sizeof(link_ksettings
));
719 err
= dev
->ethtool_ops
->get_link_ksettings(dev
, &link_ksettings
);
722 convert_link_ksettings_to_legacy_settings(&cmd
, &link_ksettings
);
724 /* send a sensible cmd tag back to user */
725 cmd
.cmd
= ETHTOOL_GSET
;
727 if (copy_to_user(useraddr
, &cmd
, sizeof(cmd
)))
733 /* Update device link settings with given ethtool_cmd.
735 * Backward compatibility note: for compatibility with legacy ethtool, this is
736 * now always implemented via set_link_settings. When user's request updates
737 * deprecated ethtool_cmd fields (transceiver/maxrxpkt/maxtxpkt), a kernel
738 * warning is logged once (with name of 1st driver/device) to recommend user to
739 * upgrade ethtool, and the request is rejected.
741 static int ethtool_set_settings(struct net_device
*dev
, void __user
*useraddr
)
743 struct ethtool_link_ksettings link_ksettings
;
744 struct ethtool_cmd cmd
;
748 if (copy_from_user(&cmd
, useraddr
, sizeof(cmd
)))
750 if (!dev
->ethtool_ops
->set_link_ksettings
)
753 if (!convert_legacy_settings_to_link_ksettings(&link_ksettings
, &cmd
))
755 link_ksettings
.base
.link_mode_masks_nwords
=
756 __ETHTOOL_LINK_MODE_MASK_NU32
;
757 return dev
->ethtool_ops
->set_link_ksettings(dev
, &link_ksettings
);
760 static noinline_for_stack
int ethtool_get_drvinfo(struct net_device
*dev
,
761 void __user
*useraddr
)
763 struct ethtool_drvinfo info
;
764 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
766 memset(&info
, 0, sizeof(info
));
767 info
.cmd
= ETHTOOL_GDRVINFO
;
768 if (ops
->get_drvinfo
) {
769 ops
->get_drvinfo(dev
, &info
);
770 } else if (dev
->dev
.parent
&& dev
->dev
.parent
->driver
) {
771 strlcpy(info
.bus_info
, dev_name(dev
->dev
.parent
),
772 sizeof(info
.bus_info
));
773 strlcpy(info
.driver
, dev
->dev
.parent
->driver
->name
,
774 sizeof(info
.driver
));
780 * this method of obtaining string set info is deprecated;
781 * Use ETHTOOL_GSSET_INFO instead.
783 if (ops
->get_sset_count
) {
786 rc
= ops
->get_sset_count(dev
, ETH_SS_TEST
);
788 info
.testinfo_len
= rc
;
789 rc
= ops
->get_sset_count(dev
, ETH_SS_STATS
);
792 rc
= ops
->get_sset_count(dev
, ETH_SS_PRIV_FLAGS
);
794 info
.n_priv_flags
= rc
;
796 if (ops
->get_regs_len
) {
797 int ret
= ops
->get_regs_len(dev
);
800 info
.regdump_len
= ret
;
803 if (ops
->get_eeprom_len
)
804 info
.eedump_len
= ops
->get_eeprom_len(dev
);
806 if (!info
.fw_version
[0])
807 devlink_compat_running_version(dev
, info
.fw_version
,
808 sizeof(info
.fw_version
));
810 if (copy_to_user(useraddr
, &info
, sizeof(info
)))
815 static noinline_for_stack
int ethtool_get_sset_info(struct net_device
*dev
,
816 void __user
*useraddr
)
818 struct ethtool_sset_info info
;
820 int i
, idx
= 0, n_bits
= 0, ret
, rc
;
821 u32
*info_buf
= NULL
;
823 if (copy_from_user(&info
, useraddr
, sizeof(info
)))
826 /* store copy of mask, because we zero struct later on */
827 sset_mask
= info
.sset_mask
;
831 /* calculate size of return buffer */
832 n_bits
= hweight64(sset_mask
);
834 memset(&info
, 0, sizeof(info
));
835 info
.cmd
= ETHTOOL_GSSET_INFO
;
837 info_buf
= kcalloc(n_bits
, sizeof(u32
), GFP_USER
);
842 * fill return buffer based on input bitmask and successful
843 * get_sset_count return
845 for (i
= 0; i
< 64; i
++) {
846 if (!(sset_mask
& (1ULL << i
)))
849 rc
= __ethtool_get_sset_count(dev
, i
);
851 info
.sset_mask
|= (1ULL << i
);
852 info_buf
[idx
++] = rc
;
857 if (copy_to_user(useraddr
, &info
, sizeof(info
)))
860 useraddr
+= offsetof(struct ethtool_sset_info
, data
);
861 if (copy_to_user(useraddr
, info_buf
, idx
* sizeof(u32
)))
871 static noinline_for_stack
int ethtool_set_rxnfc(struct net_device
*dev
,
872 u32 cmd
, void __user
*useraddr
)
874 struct ethtool_rxnfc info
;
875 size_t info_size
= sizeof(info
);
878 if (!dev
->ethtool_ops
->set_rxnfc
)
881 /* struct ethtool_rxnfc was originally defined for
882 * ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
883 * members. User-space might still be using that
885 if (cmd
== ETHTOOL_SRXFH
)
886 info_size
= (offsetof(struct ethtool_rxnfc
, data
) +
889 if (copy_from_user(&info
, useraddr
, info_size
))
892 rc
= dev
->ethtool_ops
->set_rxnfc(dev
, &info
);
896 if (cmd
== ETHTOOL_SRXCLSRLINS
&&
897 copy_to_user(useraddr
, &info
, info_size
))
903 static noinline_for_stack
int ethtool_get_rxnfc(struct net_device
*dev
,
904 u32 cmd
, void __user
*useraddr
)
906 struct ethtool_rxnfc info
;
907 size_t info_size
= sizeof(info
);
908 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
910 void *rule_buf
= NULL
;
915 /* struct ethtool_rxnfc was originally defined for
916 * ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
917 * members. User-space might still be using that
919 if (cmd
== ETHTOOL_GRXFH
)
920 info_size
= (offsetof(struct ethtool_rxnfc
, data
) +
923 if (copy_from_user(&info
, useraddr
, info_size
))
926 /* If FLOW_RSS was requested then user-space must be using the
927 * new definition, as FLOW_RSS is newer.
929 if (cmd
== ETHTOOL_GRXFH
&& info
.flow_type
& FLOW_RSS
) {
930 info_size
= sizeof(info
);
931 if (copy_from_user(&info
, useraddr
, info_size
))
933 /* Since malicious users may modify the original data,
934 * we need to check whether FLOW_RSS is still requested.
936 if (!(info
.flow_type
& FLOW_RSS
))
943 if (info
.cmd
== ETHTOOL_GRXCLSRLALL
) {
944 if (info
.rule_cnt
> 0) {
945 if (info
.rule_cnt
<= KMALLOC_MAX_SIZE
/ sizeof(u32
))
946 rule_buf
= kcalloc(info
.rule_cnt
, sizeof(u32
),
953 ret
= ops
->get_rxnfc(dev
, &info
, rule_buf
);
958 if (copy_to_user(useraddr
, &info
, info_size
))
962 useraddr
+= offsetof(struct ethtool_rxnfc
, rule_locs
);
963 if (copy_to_user(useraddr
, rule_buf
,
964 info
.rule_cnt
* sizeof(u32
)))
975 static int ethtool_copy_validate_indir(u32
*indir
, void __user
*useraddr
,
976 struct ethtool_rxnfc
*rx_rings
,
981 if (copy_from_user(indir
, useraddr
, size
* sizeof(indir
[0])))
984 /* Validate ring indices */
985 for (i
= 0; i
< size
; i
++)
986 if (indir
[i
] >= rx_rings
->data
)
992 u8 netdev_rss_key
[NETDEV_RSS_KEY_LEN
] __read_mostly
;
994 void netdev_rss_key_fill(void *buffer
, size_t len
)
996 BUG_ON(len
> sizeof(netdev_rss_key
));
997 net_get_random_once(netdev_rss_key
, sizeof(netdev_rss_key
));
998 memcpy(buffer
, netdev_rss_key
, len
);
1000 EXPORT_SYMBOL(netdev_rss_key_fill
);
1002 static int ethtool_get_max_rxfh_channel(struct net_device
*dev
, u32
*max
)
1004 u32 dev_size
, current_max
= 0;
1008 if (!dev
->ethtool_ops
->get_rxfh_indir_size
||
1009 !dev
->ethtool_ops
->get_rxfh
)
1011 dev_size
= dev
->ethtool_ops
->get_rxfh_indir_size(dev
);
1015 indir
= kcalloc(dev_size
, sizeof(indir
[0]), GFP_USER
);
1019 ret
= dev
->ethtool_ops
->get_rxfh(dev
, indir
, NULL
, NULL
);
1024 current_max
= max(current_max
, indir
[dev_size
]);
1033 static noinline_for_stack
int ethtool_get_rxfh_indir(struct net_device
*dev
,
1034 void __user
*useraddr
)
1036 u32 user_size
, dev_size
;
1040 if (!dev
->ethtool_ops
->get_rxfh_indir_size
||
1041 !dev
->ethtool_ops
->get_rxfh
)
1043 dev_size
= dev
->ethtool_ops
->get_rxfh_indir_size(dev
);
1047 if (copy_from_user(&user_size
,
1048 useraddr
+ offsetof(struct ethtool_rxfh_indir
, size
),
1052 if (copy_to_user(useraddr
+ offsetof(struct ethtool_rxfh_indir
, size
),
1053 &dev_size
, sizeof(dev_size
)))
1056 /* If the user buffer size is 0, this is just a query for the
1057 * device table size. Otherwise, if it's smaller than the
1058 * device table size it's an error.
1060 if (user_size
< dev_size
)
1061 return user_size
== 0 ? 0 : -EINVAL
;
1063 indir
= kcalloc(dev_size
, sizeof(indir
[0]), GFP_USER
);
1067 ret
= dev
->ethtool_ops
->get_rxfh(dev
, indir
, NULL
, NULL
);
1071 if (copy_to_user(useraddr
+
1072 offsetof(struct ethtool_rxfh_indir
, ring_index
[0]),
1073 indir
, dev_size
* sizeof(indir
[0])))
1081 static noinline_for_stack
int ethtool_set_rxfh_indir(struct net_device
*dev
,
1082 void __user
*useraddr
)
1084 struct ethtool_rxnfc rx_rings
;
1085 u32 user_size
, dev_size
, i
;
1087 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1089 u32 ringidx_offset
= offsetof(struct ethtool_rxfh_indir
, ring_index
[0]);
1091 if (!ops
->get_rxfh_indir_size
|| !ops
->set_rxfh
||
1095 dev_size
= ops
->get_rxfh_indir_size(dev
);
1099 if (copy_from_user(&user_size
,
1100 useraddr
+ offsetof(struct ethtool_rxfh_indir
, size
),
1104 if (user_size
!= 0 && user_size
!= dev_size
)
1107 indir
= kcalloc(dev_size
, sizeof(indir
[0]), GFP_USER
);
1111 rx_rings
.cmd
= ETHTOOL_GRXRINGS
;
1112 ret
= ops
->get_rxnfc(dev
, &rx_rings
, NULL
);
1116 if (user_size
== 0) {
1117 for (i
= 0; i
< dev_size
; i
++)
1118 indir
[i
] = ethtool_rxfh_indir_default(i
, rx_rings
.data
);
1120 ret
= ethtool_copy_validate_indir(indir
,
1121 useraddr
+ ringidx_offset
,
1128 ret
= ops
->set_rxfh(dev
, indir
, NULL
, ETH_RSS_HASH_NO_CHANGE
);
1132 /* indicate whether rxfh was set to default */
1134 dev
->priv_flags
&= ~IFF_RXFH_CONFIGURED
;
1136 dev
->priv_flags
|= IFF_RXFH_CONFIGURED
;
1143 static noinline_for_stack
int ethtool_get_rxfh(struct net_device
*dev
,
1144 void __user
*useraddr
)
1147 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1148 u32 user_indir_size
, user_key_size
;
1149 u32 dev_indir_size
= 0, dev_key_size
= 0;
1150 struct ethtool_rxfh rxfh
;
1161 if (ops
->get_rxfh_indir_size
)
1162 dev_indir_size
= ops
->get_rxfh_indir_size(dev
);
1163 if (ops
->get_rxfh_key_size
)
1164 dev_key_size
= ops
->get_rxfh_key_size(dev
);
1166 if (copy_from_user(&rxfh
, useraddr
, sizeof(rxfh
)))
1168 user_indir_size
= rxfh
.indir_size
;
1169 user_key_size
= rxfh
.key_size
;
1171 /* Check that reserved fields are 0 for now */
1172 if (rxfh
.rsvd8
[0] || rxfh
.rsvd8
[1] || rxfh
.rsvd8
[2] || rxfh
.rsvd32
)
1174 /* Most drivers don't handle rss_context, check it's 0 as well */
1175 if (rxfh
.rss_context
&& !ops
->get_rxfh_context
)
1178 rxfh
.indir_size
= dev_indir_size
;
1179 rxfh
.key_size
= dev_key_size
;
1180 if (copy_to_user(useraddr
, &rxfh
, sizeof(rxfh
)))
1183 if ((user_indir_size
&& (user_indir_size
!= dev_indir_size
)) ||
1184 (user_key_size
&& (user_key_size
!= dev_key_size
)))
1187 indir_bytes
= user_indir_size
* sizeof(indir
[0]);
1188 total_size
= indir_bytes
+ user_key_size
;
1189 rss_config
= kzalloc(total_size
, GFP_USER
);
1193 if (user_indir_size
)
1194 indir
= (u32
*)rss_config
;
1197 hkey
= rss_config
+ indir_bytes
;
1199 if (rxfh
.rss_context
)
1200 ret
= dev
->ethtool_ops
->get_rxfh_context(dev
, indir
, hkey
,
1204 ret
= dev
->ethtool_ops
->get_rxfh(dev
, indir
, hkey
, &dev_hfunc
);
1208 if (copy_to_user(useraddr
+ offsetof(struct ethtool_rxfh
, hfunc
),
1209 &dev_hfunc
, sizeof(rxfh
.hfunc
))) {
1211 } else if (copy_to_user(useraddr
+
1212 offsetof(struct ethtool_rxfh
, rss_config
[0]),
1213 rss_config
, total_size
)) {
1222 static noinline_for_stack
int ethtool_set_rxfh(struct net_device
*dev
,
1223 void __user
*useraddr
)
1226 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1227 struct ethtool_rxnfc rx_rings
;
1228 struct ethtool_rxfh rxfh
;
1229 u32 dev_indir_size
= 0, dev_key_size
= 0, i
;
1230 u32
*indir
= NULL
, indir_bytes
= 0;
1233 u32 rss_cfg_offset
= offsetof(struct ethtool_rxfh
, rss_config
[0]);
1234 bool delete = false;
1236 if (!ops
->get_rxnfc
|| !ops
->set_rxfh
)
1239 if (ops
->get_rxfh_indir_size
)
1240 dev_indir_size
= ops
->get_rxfh_indir_size(dev
);
1241 if (ops
->get_rxfh_key_size
)
1242 dev_key_size
= ops
->get_rxfh_key_size(dev
);
1244 if (copy_from_user(&rxfh
, useraddr
, sizeof(rxfh
)))
1247 /* Check that reserved fields are 0 for now */
1248 if (rxfh
.rsvd8
[0] || rxfh
.rsvd8
[1] || rxfh
.rsvd8
[2] || rxfh
.rsvd32
)
1250 /* Most drivers don't handle rss_context, check it's 0 as well */
1251 if (rxfh
.rss_context
&& !ops
->set_rxfh_context
)
1254 /* If either indir, hash key or function is valid, proceed further.
1255 * Must request at least one change: indir size, hash key or function.
1257 if ((rxfh
.indir_size
&&
1258 rxfh
.indir_size
!= ETH_RXFH_INDIR_NO_CHANGE
&&
1259 rxfh
.indir_size
!= dev_indir_size
) ||
1260 (rxfh
.key_size
&& (rxfh
.key_size
!= dev_key_size
)) ||
1261 (rxfh
.indir_size
== ETH_RXFH_INDIR_NO_CHANGE
&&
1262 rxfh
.key_size
== 0 && rxfh
.hfunc
== ETH_RSS_HASH_NO_CHANGE
))
1265 if (rxfh
.indir_size
!= ETH_RXFH_INDIR_NO_CHANGE
)
1266 indir_bytes
= dev_indir_size
* sizeof(indir
[0]);
1268 rss_config
= kzalloc(indir_bytes
+ rxfh
.key_size
, GFP_USER
);
1272 rx_rings
.cmd
= ETHTOOL_GRXRINGS
;
1273 ret
= ops
->get_rxnfc(dev
, &rx_rings
, NULL
);
1277 /* rxfh.indir_size == 0 means reset the indir table to default (master
1278 * context) or delete the context (other RSS contexts).
1279 * rxfh.indir_size == ETH_RXFH_INDIR_NO_CHANGE means leave it unchanged.
1281 if (rxfh
.indir_size
&&
1282 rxfh
.indir_size
!= ETH_RXFH_INDIR_NO_CHANGE
) {
1283 indir
= (u32
*)rss_config
;
1284 ret
= ethtool_copy_validate_indir(indir
,
1285 useraddr
+ rss_cfg_offset
,
1290 } else if (rxfh
.indir_size
== 0) {
1291 if (rxfh
.rss_context
== 0) {
1292 indir
= (u32
*)rss_config
;
1293 for (i
= 0; i
< dev_indir_size
; i
++)
1294 indir
[i
] = ethtool_rxfh_indir_default(i
, rx_rings
.data
);
1300 if (rxfh
.key_size
) {
1301 hkey
= rss_config
+ indir_bytes
;
1302 if (copy_from_user(hkey
,
1303 useraddr
+ rss_cfg_offset
+ indir_bytes
,
1310 if (rxfh
.rss_context
)
1311 ret
= ops
->set_rxfh_context(dev
, indir
, hkey
, rxfh
.hfunc
,
1312 &rxfh
.rss_context
, delete);
1314 ret
= ops
->set_rxfh(dev
, indir
, hkey
, rxfh
.hfunc
);
1318 if (copy_to_user(useraddr
+ offsetof(struct ethtool_rxfh
, rss_context
),
1319 &rxfh
.rss_context
, sizeof(rxfh
.rss_context
)))
1322 if (!rxfh
.rss_context
) {
1323 /* indicate whether rxfh was set to default */
1324 if (rxfh
.indir_size
== 0)
1325 dev
->priv_flags
&= ~IFF_RXFH_CONFIGURED
;
1326 else if (rxfh
.indir_size
!= ETH_RXFH_INDIR_NO_CHANGE
)
1327 dev
->priv_flags
|= IFF_RXFH_CONFIGURED
;
1335 static int ethtool_get_regs(struct net_device
*dev
, char __user
*useraddr
)
1337 struct ethtool_regs regs
;
1338 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1342 if (!ops
->get_regs
|| !ops
->get_regs_len
)
1345 if (copy_from_user(®s
, useraddr
, sizeof(regs
)))
1348 reglen
= ops
->get_regs_len(dev
);
1352 if (regs
.len
> reglen
)
1355 regbuf
= vzalloc(reglen
);
1359 if (regs
.len
< reglen
)
1362 ops
->get_regs(dev
, ®s
, regbuf
);
1365 if (copy_to_user(useraddr
, ®s
, sizeof(regs
)))
1367 useraddr
+= offsetof(struct ethtool_regs
, data
);
1368 if (copy_to_user(useraddr
, regbuf
, reglen
))
1377 static int ethtool_reset(struct net_device
*dev
, char __user
*useraddr
)
1379 struct ethtool_value reset
;
1382 if (!dev
->ethtool_ops
->reset
)
1385 if (copy_from_user(&reset
, useraddr
, sizeof(reset
)))
1388 ret
= dev
->ethtool_ops
->reset(dev
, &reset
.data
);
1392 if (copy_to_user(useraddr
, &reset
, sizeof(reset
)))
1397 static int ethtool_get_wol(struct net_device
*dev
, char __user
*useraddr
)
1399 struct ethtool_wolinfo wol
;
1401 if (!dev
->ethtool_ops
->get_wol
)
1404 memset(&wol
, 0, sizeof(struct ethtool_wolinfo
));
1405 wol
.cmd
= ETHTOOL_GWOL
;
1406 dev
->ethtool_ops
->get_wol(dev
, &wol
);
1408 if (copy_to_user(useraddr
, &wol
, sizeof(wol
)))
1413 static int ethtool_set_wol(struct net_device
*dev
, char __user
*useraddr
)
1415 struct ethtool_wolinfo wol
;
1418 if (!dev
->ethtool_ops
->set_wol
)
1421 if (copy_from_user(&wol
, useraddr
, sizeof(wol
)))
1424 ret
= dev
->ethtool_ops
->set_wol(dev
, &wol
);
1428 dev
->wol_enabled
= !!wol
.wolopts
;
1433 static int ethtool_get_eee(struct net_device
*dev
, char __user
*useraddr
)
1435 struct ethtool_eee edata
;
1438 if (!dev
->ethtool_ops
->get_eee
)
1441 memset(&edata
, 0, sizeof(struct ethtool_eee
));
1442 edata
.cmd
= ETHTOOL_GEEE
;
1443 rc
= dev
->ethtool_ops
->get_eee(dev
, &edata
);
1448 if (copy_to_user(useraddr
, &edata
, sizeof(edata
)))
1454 static int ethtool_set_eee(struct net_device
*dev
, char __user
*useraddr
)
1456 struct ethtool_eee edata
;
1458 if (!dev
->ethtool_ops
->set_eee
)
1461 if (copy_from_user(&edata
, useraddr
, sizeof(edata
)))
1464 return dev
->ethtool_ops
->set_eee(dev
, &edata
);
1467 static int ethtool_nway_reset(struct net_device
*dev
)
1469 if (!dev
->ethtool_ops
->nway_reset
)
1472 return dev
->ethtool_ops
->nway_reset(dev
);
1475 static int ethtool_get_link(struct net_device
*dev
, char __user
*useraddr
)
1477 struct ethtool_value edata
= { .cmd
= ETHTOOL_GLINK
};
1479 if (!dev
->ethtool_ops
->get_link
)
1482 edata
.data
= netif_running(dev
) && dev
->ethtool_ops
->get_link(dev
);
1484 if (copy_to_user(useraddr
, &edata
, sizeof(edata
)))
1489 static int ethtool_get_any_eeprom(struct net_device
*dev
, void __user
*useraddr
,
1490 int (*getter
)(struct net_device
*,
1491 struct ethtool_eeprom
*, u8
*),
1494 struct ethtool_eeprom eeprom
;
1495 void __user
*userbuf
= useraddr
+ sizeof(eeprom
);
1496 u32 bytes_remaining
;
1500 if (copy_from_user(&eeprom
, useraddr
, sizeof(eeprom
)))
1503 /* Check for wrap and zero */
1504 if (eeprom
.offset
+ eeprom
.len
<= eeprom
.offset
)
1507 /* Check for exceeding total eeprom len */
1508 if (eeprom
.offset
+ eeprom
.len
> total_len
)
1511 data
= kmalloc(PAGE_SIZE
, GFP_USER
);
1515 bytes_remaining
= eeprom
.len
;
1516 while (bytes_remaining
> 0) {
1517 eeprom
.len
= min(bytes_remaining
, (u32
)PAGE_SIZE
);
1519 ret
= getter(dev
, &eeprom
, data
);
1522 if (copy_to_user(userbuf
, data
, eeprom
.len
)) {
1526 userbuf
+= eeprom
.len
;
1527 eeprom
.offset
+= eeprom
.len
;
1528 bytes_remaining
-= eeprom
.len
;
1531 eeprom
.len
= userbuf
- (useraddr
+ sizeof(eeprom
));
1532 eeprom
.offset
-= eeprom
.len
;
1533 if (copy_to_user(useraddr
, &eeprom
, sizeof(eeprom
)))
1540 static int ethtool_get_eeprom(struct net_device
*dev
, void __user
*useraddr
)
1542 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1544 if (!ops
->get_eeprom
|| !ops
->get_eeprom_len
||
1545 !ops
->get_eeprom_len(dev
))
1548 return ethtool_get_any_eeprom(dev
, useraddr
, ops
->get_eeprom
,
1549 ops
->get_eeprom_len(dev
));
1552 static int ethtool_set_eeprom(struct net_device
*dev
, void __user
*useraddr
)
1554 struct ethtool_eeprom eeprom
;
1555 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1556 void __user
*userbuf
= useraddr
+ sizeof(eeprom
);
1557 u32 bytes_remaining
;
1561 if (!ops
->set_eeprom
|| !ops
->get_eeprom_len
||
1562 !ops
->get_eeprom_len(dev
))
1565 if (copy_from_user(&eeprom
, useraddr
, sizeof(eeprom
)))
1568 /* Check for wrap and zero */
1569 if (eeprom
.offset
+ eeprom
.len
<= eeprom
.offset
)
1572 /* Check for exceeding total eeprom len */
1573 if (eeprom
.offset
+ eeprom
.len
> ops
->get_eeprom_len(dev
))
1576 data
= kmalloc(PAGE_SIZE
, GFP_USER
);
1580 bytes_remaining
= eeprom
.len
;
1581 while (bytes_remaining
> 0) {
1582 eeprom
.len
= min(bytes_remaining
, (u32
)PAGE_SIZE
);
1584 if (copy_from_user(data
, userbuf
, eeprom
.len
)) {
1588 ret
= ops
->set_eeprom(dev
, &eeprom
, data
);
1591 userbuf
+= eeprom
.len
;
1592 eeprom
.offset
+= eeprom
.len
;
1593 bytes_remaining
-= eeprom
.len
;
1600 static noinline_for_stack
int ethtool_get_coalesce(struct net_device
*dev
,
1601 void __user
*useraddr
)
1603 struct ethtool_coalesce coalesce
= { .cmd
= ETHTOOL_GCOALESCE
};
1605 if (!dev
->ethtool_ops
->get_coalesce
)
1608 dev
->ethtool_ops
->get_coalesce(dev
, &coalesce
);
1610 if (copy_to_user(useraddr
, &coalesce
, sizeof(coalesce
)))
1615 static noinline_for_stack
int ethtool_set_coalesce(struct net_device
*dev
,
1616 void __user
*useraddr
)
1618 struct ethtool_coalesce coalesce
;
1620 if (!dev
->ethtool_ops
->set_coalesce
)
1623 if (copy_from_user(&coalesce
, useraddr
, sizeof(coalesce
)))
1626 return dev
->ethtool_ops
->set_coalesce(dev
, &coalesce
);
1629 static int ethtool_get_ringparam(struct net_device
*dev
, void __user
*useraddr
)
1631 struct ethtool_ringparam ringparam
= { .cmd
= ETHTOOL_GRINGPARAM
};
1633 if (!dev
->ethtool_ops
->get_ringparam
)
1636 dev
->ethtool_ops
->get_ringparam(dev
, &ringparam
);
1638 if (copy_to_user(useraddr
, &ringparam
, sizeof(ringparam
)))
1643 static int ethtool_set_ringparam(struct net_device
*dev
, void __user
*useraddr
)
1645 struct ethtool_ringparam ringparam
, max
= { .cmd
= ETHTOOL_GRINGPARAM
};
1647 if (!dev
->ethtool_ops
->set_ringparam
|| !dev
->ethtool_ops
->get_ringparam
)
1650 if (copy_from_user(&ringparam
, useraddr
, sizeof(ringparam
)))
1653 dev
->ethtool_ops
->get_ringparam(dev
, &max
);
1655 /* ensure new ring parameters are within the maximums */
1656 if (ringparam
.rx_pending
> max
.rx_max_pending
||
1657 ringparam
.rx_mini_pending
> max
.rx_mini_max_pending
||
1658 ringparam
.rx_jumbo_pending
> max
.rx_jumbo_max_pending
||
1659 ringparam
.tx_pending
> max
.tx_max_pending
)
1662 return dev
->ethtool_ops
->set_ringparam(dev
, &ringparam
);
1665 static noinline_for_stack
int ethtool_get_channels(struct net_device
*dev
,
1666 void __user
*useraddr
)
1668 struct ethtool_channels channels
= { .cmd
= ETHTOOL_GCHANNELS
};
1670 if (!dev
->ethtool_ops
->get_channels
)
1673 dev
->ethtool_ops
->get_channels(dev
, &channels
);
1675 if (copy_to_user(useraddr
, &channels
, sizeof(channels
)))
1680 static noinline_for_stack
int ethtool_set_channels(struct net_device
*dev
,
1681 void __user
*useraddr
)
1683 struct ethtool_channels channels
, curr
= { .cmd
= ETHTOOL_GCHANNELS
};
1684 u16 from_channel
, to_channel
;
1685 u32 max_rx_in_use
= 0;
1688 if (!dev
->ethtool_ops
->set_channels
|| !dev
->ethtool_ops
->get_channels
)
1691 if (copy_from_user(&channels
, useraddr
, sizeof(channels
)))
1694 dev
->ethtool_ops
->get_channels(dev
, &curr
);
1696 /* ensure new counts are within the maximums */
1697 if (channels
.rx_count
> curr
.max_rx
||
1698 channels
.tx_count
> curr
.max_tx
||
1699 channels
.combined_count
> curr
.max_combined
||
1700 channels
.other_count
> curr
.max_other
)
1703 /* ensure the new Rx count fits within the configured Rx flow
1704 * indirection table settings */
1705 if (netif_is_rxfh_configured(dev
) &&
1706 !ethtool_get_max_rxfh_channel(dev
, &max_rx_in_use
) &&
1707 (channels
.combined_count
+ channels
.rx_count
) <= max_rx_in_use
)
1710 /* Disabling channels, query zero-copy AF_XDP sockets */
1711 from_channel
= channels
.combined_count
+
1712 min(channels
.rx_count
, channels
.tx_count
);
1713 to_channel
= curr
.combined_count
+ max(curr
.rx_count
, curr
.tx_count
);
1714 for (i
= from_channel
; i
< to_channel
; i
++)
1715 if (xdp_get_umem_from_qid(dev
, i
))
1718 return dev
->ethtool_ops
->set_channels(dev
, &channels
);
1721 static int ethtool_get_pauseparam(struct net_device
*dev
, void __user
*useraddr
)
1723 struct ethtool_pauseparam pauseparam
= { .cmd
= ETHTOOL_GPAUSEPARAM
};
1725 if (!dev
->ethtool_ops
->get_pauseparam
)
1728 dev
->ethtool_ops
->get_pauseparam(dev
, &pauseparam
);
1730 if (copy_to_user(useraddr
, &pauseparam
, sizeof(pauseparam
)))
1735 static int ethtool_set_pauseparam(struct net_device
*dev
, void __user
*useraddr
)
1737 struct ethtool_pauseparam pauseparam
;
1739 if (!dev
->ethtool_ops
->set_pauseparam
)
1742 if (copy_from_user(&pauseparam
, useraddr
, sizeof(pauseparam
)))
1745 return dev
->ethtool_ops
->set_pauseparam(dev
, &pauseparam
);
1748 static int ethtool_self_test(struct net_device
*dev
, char __user
*useraddr
)
1750 struct ethtool_test test
;
1751 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1755 if (!ops
->self_test
|| !ops
->get_sset_count
)
1758 test_len
= ops
->get_sset_count(dev
, ETH_SS_TEST
);
1761 WARN_ON(test_len
== 0);
1763 if (copy_from_user(&test
, useraddr
, sizeof(test
)))
1766 test
.len
= test_len
;
1767 data
= kmalloc_array(test_len
, sizeof(u64
), GFP_USER
);
1771 ops
->self_test(dev
, &test
, data
);
1774 if (copy_to_user(useraddr
, &test
, sizeof(test
)))
1776 useraddr
+= sizeof(test
);
1777 if (copy_to_user(useraddr
, data
, test
.len
* sizeof(u64
)))
1786 static int ethtool_get_strings(struct net_device
*dev
, void __user
*useraddr
)
1788 struct ethtool_gstrings gstrings
;
1792 if (copy_from_user(&gstrings
, useraddr
, sizeof(gstrings
)))
1795 ret
= __ethtool_get_sset_count(dev
, gstrings
.string_set
);
1798 if (ret
> S32_MAX
/ ETH_GSTRING_LEN
)
1805 data
= vzalloc(array_size(gstrings
.len
, ETH_GSTRING_LEN
));
1809 __ethtool_get_strings(dev
, gstrings
.string_set
, data
);
1815 if (copy_to_user(useraddr
, &gstrings
, sizeof(gstrings
)))
1817 useraddr
+= sizeof(gstrings
);
1819 copy_to_user(useraddr
, data
, gstrings
.len
* ETH_GSTRING_LEN
))
1828 static int ethtool_phys_id(struct net_device
*dev
, void __user
*useraddr
)
1830 struct ethtool_value id
;
1832 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1835 if (!ops
->set_phys_id
)
1841 if (copy_from_user(&id
, useraddr
, sizeof(id
)))
1844 rc
= ops
->set_phys_id(dev
, ETHTOOL_ID_ACTIVE
);
1848 /* Drop the RTNL lock while waiting, but prevent reentry or
1849 * removal of the device.
1856 /* Driver will handle this itself */
1857 schedule_timeout_interruptible(
1858 id
.data
? (id
.data
* HZ
) : MAX_SCHEDULE_TIMEOUT
);
1860 /* Driver expects to be called at twice the frequency in rc */
1861 int n
= rc
* 2, i
, interval
= HZ
/ n
;
1863 /* Count down seconds */
1865 /* Count down iterations per second */
1869 rc
= ops
->set_phys_id(dev
,
1870 (i
& 1) ? ETHTOOL_ID_OFF
: ETHTOOL_ID_ON
);
1874 schedule_timeout_interruptible(interval
);
1875 } while (!signal_pending(current
) && --i
!= 0);
1876 } while (!signal_pending(current
) &&
1877 (id
.data
== 0 || --id
.data
!= 0));
1884 (void) ops
->set_phys_id(dev
, ETHTOOL_ID_INACTIVE
);
1888 static int ethtool_get_stats(struct net_device
*dev
, void __user
*useraddr
)
1890 struct ethtool_stats stats
;
1891 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1895 if (!ops
->get_ethtool_stats
|| !ops
->get_sset_count
)
1898 n_stats
= ops
->get_sset_count(dev
, ETH_SS_STATS
);
1901 if (n_stats
> S32_MAX
/ sizeof(u64
))
1903 WARN_ON_ONCE(!n_stats
);
1904 if (copy_from_user(&stats
, useraddr
, sizeof(stats
)))
1907 stats
.n_stats
= n_stats
;
1910 data
= vzalloc(array_size(n_stats
, sizeof(u64
)));
1913 ops
->get_ethtool_stats(dev
, &stats
, data
);
1919 if (copy_to_user(useraddr
, &stats
, sizeof(stats
)))
1921 useraddr
+= sizeof(stats
);
1922 if (n_stats
&& copy_to_user(useraddr
, data
, n_stats
* sizeof(u64
)))
1931 static int ethtool_get_phy_stats(struct net_device
*dev
, void __user
*useraddr
)
1933 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
1934 struct phy_device
*phydev
= dev
->phydev
;
1935 struct ethtool_stats stats
;
1939 if (!phydev
&& (!ops
->get_ethtool_phy_stats
|| !ops
->get_sset_count
))
1942 if (dev
->phydev
&& !ops
->get_ethtool_phy_stats
)
1943 n_stats
= phy_ethtool_get_sset_count(dev
->phydev
);
1945 n_stats
= ops
->get_sset_count(dev
, ETH_SS_PHY_STATS
);
1948 if (n_stats
> S32_MAX
/ sizeof(u64
))
1950 WARN_ON_ONCE(!n_stats
);
1952 if (copy_from_user(&stats
, useraddr
, sizeof(stats
)))
1955 stats
.n_stats
= n_stats
;
1958 data
= vzalloc(array_size(n_stats
, sizeof(u64
)));
1962 if (dev
->phydev
&& !ops
->get_ethtool_phy_stats
) {
1963 ret
= phy_ethtool_get_stats(dev
->phydev
, &stats
, data
);
1967 ops
->get_ethtool_phy_stats(dev
, &stats
, data
);
1974 if (copy_to_user(useraddr
, &stats
, sizeof(stats
)))
1976 useraddr
+= sizeof(stats
);
1977 if (n_stats
&& copy_to_user(useraddr
, data
, n_stats
* sizeof(u64
)))
1986 static int ethtool_get_perm_addr(struct net_device
*dev
, void __user
*useraddr
)
1988 struct ethtool_perm_addr epaddr
;
1990 if (copy_from_user(&epaddr
, useraddr
, sizeof(epaddr
)))
1993 if (epaddr
.size
< dev
->addr_len
)
1995 epaddr
.size
= dev
->addr_len
;
1997 if (copy_to_user(useraddr
, &epaddr
, sizeof(epaddr
)))
1999 useraddr
+= sizeof(epaddr
);
2000 if (copy_to_user(useraddr
, dev
->perm_addr
, epaddr
.size
))
2005 static int ethtool_get_value(struct net_device
*dev
, char __user
*useraddr
,
2006 u32 cmd
, u32 (*actor
)(struct net_device
*))
2008 struct ethtool_value edata
= { .cmd
= cmd
};
2013 edata
.data
= actor(dev
);
2015 if (copy_to_user(useraddr
, &edata
, sizeof(edata
)))
2020 static int ethtool_set_value_void(struct net_device
*dev
, char __user
*useraddr
,
2021 void (*actor
)(struct net_device
*, u32
))
2023 struct ethtool_value edata
;
2028 if (copy_from_user(&edata
, useraddr
, sizeof(edata
)))
2031 actor(dev
, edata
.data
);
2035 static int ethtool_set_value(struct net_device
*dev
, char __user
*useraddr
,
2036 int (*actor
)(struct net_device
*, u32
))
2038 struct ethtool_value edata
;
2043 if (copy_from_user(&edata
, useraddr
, sizeof(edata
)))
2046 return actor(dev
, edata
.data
);
2049 static noinline_for_stack
int ethtool_flash_device(struct net_device
*dev
,
2050 char __user
*useraddr
)
2052 struct ethtool_flash efl
;
2054 if (copy_from_user(&efl
, useraddr
, sizeof(efl
)))
2056 efl
.data
[ETHTOOL_FLASH_MAX_FILENAME
- 1] = 0;
2058 if (!dev
->ethtool_ops
->flash_device
)
2059 return devlink_compat_flash_update(dev
, efl
.data
);
2061 return dev
->ethtool_ops
->flash_device(dev
, &efl
);
2064 static int ethtool_set_dump(struct net_device
*dev
,
2065 void __user
*useraddr
)
2067 struct ethtool_dump dump
;
2069 if (!dev
->ethtool_ops
->set_dump
)
2072 if (copy_from_user(&dump
, useraddr
, sizeof(dump
)))
2075 return dev
->ethtool_ops
->set_dump(dev
, &dump
);
2078 static int ethtool_get_dump_flag(struct net_device
*dev
,
2079 void __user
*useraddr
)
2082 struct ethtool_dump dump
;
2083 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2085 if (!ops
->get_dump_flag
)
2088 if (copy_from_user(&dump
, useraddr
, sizeof(dump
)))
2091 ret
= ops
->get_dump_flag(dev
, &dump
);
2095 if (copy_to_user(useraddr
, &dump
, sizeof(dump
)))
2100 static int ethtool_get_dump_data(struct net_device
*dev
,
2101 void __user
*useraddr
)
2105 struct ethtool_dump dump
, tmp
;
2106 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2109 if (!ops
->get_dump_data
|| !ops
->get_dump_flag
)
2112 if (copy_from_user(&dump
, useraddr
, sizeof(dump
)))
2115 memset(&tmp
, 0, sizeof(tmp
));
2116 tmp
.cmd
= ETHTOOL_GET_DUMP_FLAG
;
2117 ret
= ops
->get_dump_flag(dev
, &tmp
);
2121 len
= min(tmp
.len
, dump
.len
);
2125 /* Don't ever let the driver think there's more space available
2126 * than it requested with .get_dump_flag().
2130 /* Always allocate enough space to hold the whole thing so that the
2131 * driver does not need to check the length and bother with partial
2134 data
= vzalloc(tmp
.len
);
2137 ret
= ops
->get_dump_data(dev
, &dump
, data
);
2141 /* There are two sane possibilities:
2142 * 1. The driver's .get_dump_data() does not touch dump.len.
2143 * 2. Or it may set dump.len to how much it really writes, which
2144 * should be tmp.len (or len if it can do a partial dump).
2145 * In any case respond to userspace with the actual length of data
2148 WARN_ON(dump
.len
!= len
&& dump
.len
!= tmp
.len
);
2151 if (copy_to_user(useraddr
, &dump
, sizeof(dump
))) {
2155 useraddr
+= offsetof(struct ethtool_dump
, data
);
2156 if (copy_to_user(useraddr
, data
, len
))
2163 static int ethtool_get_ts_info(struct net_device
*dev
, void __user
*useraddr
)
2166 struct ethtool_ts_info info
;
2167 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2168 struct phy_device
*phydev
= dev
->phydev
;
2170 memset(&info
, 0, sizeof(info
));
2171 info
.cmd
= ETHTOOL_GET_TS_INFO
;
2173 if (phydev
&& phydev
->drv
&& phydev
->drv
->ts_info
) {
2174 err
= phydev
->drv
->ts_info(phydev
, &info
);
2175 } else if (ops
->get_ts_info
) {
2176 err
= ops
->get_ts_info(dev
, &info
);
2178 info
.so_timestamping
=
2179 SOF_TIMESTAMPING_RX_SOFTWARE
|
2180 SOF_TIMESTAMPING_SOFTWARE
;
2181 info
.phc_index
= -1;
2187 if (copy_to_user(useraddr
, &info
, sizeof(info
)))
2193 static int __ethtool_get_module_info(struct net_device
*dev
,
2194 struct ethtool_modinfo
*modinfo
)
2196 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2197 struct phy_device
*phydev
= dev
->phydev
;
2200 return sfp_get_module_info(dev
->sfp_bus
, modinfo
);
2202 if (phydev
&& phydev
->drv
&& phydev
->drv
->module_info
)
2203 return phydev
->drv
->module_info(phydev
, modinfo
);
2205 if (ops
->get_module_info
)
2206 return ops
->get_module_info(dev
, modinfo
);
2211 static int ethtool_get_module_info(struct net_device
*dev
,
2212 void __user
*useraddr
)
2215 struct ethtool_modinfo modinfo
;
2217 if (copy_from_user(&modinfo
, useraddr
, sizeof(modinfo
)))
2220 ret
= __ethtool_get_module_info(dev
, &modinfo
);
2224 if (copy_to_user(useraddr
, &modinfo
, sizeof(modinfo
)))
2230 static int __ethtool_get_module_eeprom(struct net_device
*dev
,
2231 struct ethtool_eeprom
*ee
, u8
*data
)
2233 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2234 struct phy_device
*phydev
= dev
->phydev
;
2237 return sfp_get_module_eeprom(dev
->sfp_bus
, ee
, data
);
2239 if (phydev
&& phydev
->drv
&& phydev
->drv
->module_eeprom
)
2240 return phydev
->drv
->module_eeprom(phydev
, ee
, data
);
2242 if (ops
->get_module_eeprom
)
2243 return ops
->get_module_eeprom(dev
, ee
, data
);
2248 static int ethtool_get_module_eeprom(struct net_device
*dev
,
2249 void __user
*useraddr
)
2252 struct ethtool_modinfo modinfo
;
2254 ret
= __ethtool_get_module_info(dev
, &modinfo
);
2258 return ethtool_get_any_eeprom(dev
, useraddr
,
2259 __ethtool_get_module_eeprom
,
2260 modinfo
.eeprom_len
);
2263 static int ethtool_tunable_valid(const struct ethtool_tunable
*tuna
)
2266 case ETHTOOL_RX_COPYBREAK
:
2267 case ETHTOOL_TX_COPYBREAK
:
2268 if (tuna
->len
!= sizeof(u32
) ||
2269 tuna
->type_id
!= ETHTOOL_TUNABLE_U32
)
2272 case ETHTOOL_PFC_PREVENTION_TOUT
:
2273 if (tuna
->len
!= sizeof(u16
) ||
2274 tuna
->type_id
!= ETHTOOL_TUNABLE_U16
)
2284 static int ethtool_get_tunable(struct net_device
*dev
, void __user
*useraddr
)
2287 struct ethtool_tunable tuna
;
2288 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2291 if (!ops
->get_tunable
)
2293 if (copy_from_user(&tuna
, useraddr
, sizeof(tuna
)))
2295 ret
= ethtool_tunable_valid(&tuna
);
2298 data
= kmalloc(tuna
.len
, GFP_USER
);
2301 ret
= ops
->get_tunable(dev
, &tuna
, data
);
2304 useraddr
+= sizeof(tuna
);
2306 if (copy_to_user(useraddr
, data
, tuna
.len
))
2315 static int ethtool_set_tunable(struct net_device
*dev
, void __user
*useraddr
)
2318 struct ethtool_tunable tuna
;
2319 const struct ethtool_ops
*ops
= dev
->ethtool_ops
;
2322 if (!ops
->set_tunable
)
2324 if (copy_from_user(&tuna
, useraddr
, sizeof(tuna
)))
2326 ret
= ethtool_tunable_valid(&tuna
);
2329 useraddr
+= sizeof(tuna
);
2330 data
= memdup_user(useraddr
, tuna
.len
);
2332 return PTR_ERR(data
);
2333 ret
= ops
->set_tunable(dev
, &tuna
, data
);
2339 static noinline_for_stack
int
2340 ethtool_get_per_queue_coalesce(struct net_device
*dev
,
2341 void __user
*useraddr
,
2342 struct ethtool_per_queue_op
*per_queue_opt
)
2346 DECLARE_BITMAP(queue_mask
, MAX_NUM_QUEUE
);
2348 if (!dev
->ethtool_ops
->get_per_queue_coalesce
)
2351 useraddr
+= sizeof(*per_queue_opt
);
2353 bitmap_from_arr32(queue_mask
, per_queue_opt
->queue_mask
,
2356 for_each_set_bit(bit
, queue_mask
, MAX_NUM_QUEUE
) {
2357 struct ethtool_coalesce coalesce
= { .cmd
= ETHTOOL_GCOALESCE
};
2359 ret
= dev
->ethtool_ops
->get_per_queue_coalesce(dev
, bit
, &coalesce
);
2362 if (copy_to_user(useraddr
, &coalesce
, sizeof(coalesce
)))
2364 useraddr
+= sizeof(coalesce
);
2370 static noinline_for_stack
int
2371 ethtool_set_per_queue_coalesce(struct net_device
*dev
,
2372 void __user
*useraddr
,
2373 struct ethtool_per_queue_op
*per_queue_opt
)
2378 struct ethtool_coalesce
*backup
= NULL
, *tmp
= NULL
;
2379 DECLARE_BITMAP(queue_mask
, MAX_NUM_QUEUE
);
2381 if ((!dev
->ethtool_ops
->set_per_queue_coalesce
) ||
2382 (!dev
->ethtool_ops
->get_per_queue_coalesce
))
2385 useraddr
+= sizeof(*per_queue_opt
);
2387 bitmap_from_arr32(queue_mask
, per_queue_opt
->queue_mask
, MAX_NUM_QUEUE
);
2388 n_queue
= bitmap_weight(queue_mask
, MAX_NUM_QUEUE
);
2389 tmp
= backup
= kmalloc_array(n_queue
, sizeof(*backup
), GFP_KERNEL
);
2393 for_each_set_bit(bit
, queue_mask
, MAX_NUM_QUEUE
) {
2394 struct ethtool_coalesce coalesce
;
2396 ret
= dev
->ethtool_ops
->get_per_queue_coalesce(dev
, bit
, tmp
);
2402 if (copy_from_user(&coalesce
, useraddr
, sizeof(coalesce
))) {
2407 ret
= dev
->ethtool_ops
->set_per_queue_coalesce(dev
, bit
, &coalesce
);
2411 useraddr
+= sizeof(coalesce
);
2417 for_each_set_bit(i
, queue_mask
, bit
) {
2418 dev
->ethtool_ops
->set_per_queue_coalesce(dev
, i
, tmp
);
2427 static int noinline_for_stack
ethtool_set_per_queue(struct net_device
*dev
,
2428 void __user
*useraddr
, u32 sub_cmd
)
2430 struct ethtool_per_queue_op per_queue_opt
;
2432 if (copy_from_user(&per_queue_opt
, useraddr
, sizeof(per_queue_opt
)))
2435 if (per_queue_opt
.sub_command
!= sub_cmd
)
2438 switch (per_queue_opt
.sub_command
) {
2439 case ETHTOOL_GCOALESCE
:
2440 return ethtool_get_per_queue_coalesce(dev
, useraddr
, &per_queue_opt
);
2441 case ETHTOOL_SCOALESCE
:
2442 return ethtool_set_per_queue_coalesce(dev
, useraddr
, &per_queue_opt
);
2448 static int ethtool_phy_tunable_valid(const struct ethtool_tunable
*tuna
)
2451 case ETHTOOL_PHY_DOWNSHIFT
:
2452 case ETHTOOL_PHY_FAST_LINK_DOWN
:
2453 if (tuna
->len
!= sizeof(u8
) ||
2454 tuna
->type_id
!= ETHTOOL_TUNABLE_U8
)
2457 case ETHTOOL_PHY_EDPD
:
2458 if (tuna
->len
!= sizeof(u16
) ||
2459 tuna
->type_id
!= ETHTOOL_TUNABLE_U16
)
2469 static int get_phy_tunable(struct net_device
*dev
, void __user
*useraddr
)
2472 struct ethtool_tunable tuna
;
2473 struct phy_device
*phydev
= dev
->phydev
;
2476 if (!(phydev
&& phydev
->drv
&& phydev
->drv
->get_tunable
))
2479 if (copy_from_user(&tuna
, useraddr
, sizeof(tuna
)))
2481 ret
= ethtool_phy_tunable_valid(&tuna
);
2484 data
= kmalloc(tuna
.len
, GFP_USER
);
2487 mutex_lock(&phydev
->lock
);
2488 ret
= phydev
->drv
->get_tunable(phydev
, &tuna
, data
);
2489 mutex_unlock(&phydev
->lock
);
2492 useraddr
+= sizeof(tuna
);
2494 if (copy_to_user(useraddr
, data
, tuna
.len
))
2503 static int set_phy_tunable(struct net_device
*dev
, void __user
*useraddr
)
2506 struct ethtool_tunable tuna
;
2507 struct phy_device
*phydev
= dev
->phydev
;
2510 if (!(phydev
&& phydev
->drv
&& phydev
->drv
->set_tunable
))
2512 if (copy_from_user(&tuna
, useraddr
, sizeof(tuna
)))
2514 ret
= ethtool_phy_tunable_valid(&tuna
);
2517 useraddr
+= sizeof(tuna
);
2518 data
= memdup_user(useraddr
, tuna
.len
);
2520 return PTR_ERR(data
);
2521 mutex_lock(&phydev
->lock
);
2522 ret
= phydev
->drv
->set_tunable(phydev
, &tuna
, data
);
2523 mutex_unlock(&phydev
->lock
);
2529 static int ethtool_get_fecparam(struct net_device
*dev
, void __user
*useraddr
)
2531 struct ethtool_fecparam fecparam
= { .cmd
= ETHTOOL_GFECPARAM
};
2534 if (!dev
->ethtool_ops
->get_fecparam
)
2537 rc
= dev
->ethtool_ops
->get_fecparam(dev
, &fecparam
);
2541 if (copy_to_user(useraddr
, &fecparam
, sizeof(fecparam
)))
2546 static int ethtool_set_fecparam(struct net_device
*dev
, void __user
*useraddr
)
2548 struct ethtool_fecparam fecparam
;
2550 if (!dev
->ethtool_ops
->set_fecparam
)
2553 if (copy_from_user(&fecparam
, useraddr
, sizeof(fecparam
)))
2556 return dev
->ethtool_ops
->set_fecparam(dev
, &fecparam
);
2559 /* The main entry point in this file. Called from net/core/dev_ioctl.c */
2561 int dev_ethtool(struct net
*net
, struct ifreq
*ifr
)
2563 struct net_device
*dev
= __dev_get_by_name(net
, ifr
->ifr_name
);
2564 void __user
*useraddr
= ifr
->ifr_data
;
2565 u32 ethcmd
, sub_cmd
;
2567 netdev_features_t old_features
;
2569 if (!dev
|| !netif_device_present(dev
))
2572 if (copy_from_user(ðcmd
, useraddr
, sizeof(ethcmd
)))
2575 if (ethcmd
== ETHTOOL_PERQUEUE
) {
2576 if (copy_from_user(&sub_cmd
, useraddr
+ sizeof(ethcmd
), sizeof(sub_cmd
)))
2581 /* Allow some commands to be done by anyone */
2584 case ETHTOOL_GDRVINFO
:
2585 case ETHTOOL_GMSGLVL
:
2587 case ETHTOOL_GCOALESCE
:
2588 case ETHTOOL_GRINGPARAM
:
2589 case ETHTOOL_GPAUSEPARAM
:
2590 case ETHTOOL_GRXCSUM
:
2591 case ETHTOOL_GTXCSUM
:
2593 case ETHTOOL_GSSET_INFO
:
2594 case ETHTOOL_GSTRINGS
:
2595 case ETHTOOL_GSTATS
:
2596 case ETHTOOL_GPHYSTATS
:
2598 case ETHTOOL_GPERMADDR
:
2602 case ETHTOOL_GFLAGS
:
2603 case ETHTOOL_GPFLAGS
:
2605 case ETHTOOL_GRXRINGS
:
2606 case ETHTOOL_GRXCLSRLCNT
:
2607 case ETHTOOL_GRXCLSRULE
:
2608 case ETHTOOL_GRXCLSRLALL
:
2609 case ETHTOOL_GRXFHINDIR
:
2611 case ETHTOOL_GFEATURES
:
2612 case ETHTOOL_GCHANNELS
:
2613 case ETHTOOL_GET_TS_INFO
:
2615 case ETHTOOL_GTUNABLE
:
2616 case ETHTOOL_PHY_GTUNABLE
:
2617 case ETHTOOL_GLINKSETTINGS
:
2618 case ETHTOOL_GFECPARAM
:
2621 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
))
2625 if (dev
->ethtool_ops
->begin
) {
2626 rc
= dev
->ethtool_ops
->begin(dev
);
2630 old_features
= dev
->features
;
2634 rc
= ethtool_get_settings(dev
, useraddr
);
2637 rc
= ethtool_set_settings(dev
, useraddr
);
2639 case ETHTOOL_GDRVINFO
:
2640 rc
= ethtool_get_drvinfo(dev
, useraddr
);
2643 rc
= ethtool_get_regs(dev
, useraddr
);
2646 rc
= ethtool_get_wol(dev
, useraddr
);
2649 rc
= ethtool_set_wol(dev
, useraddr
);
2651 case ETHTOOL_GMSGLVL
:
2652 rc
= ethtool_get_value(dev
, useraddr
, ethcmd
,
2653 dev
->ethtool_ops
->get_msglevel
);
2655 case ETHTOOL_SMSGLVL
:
2656 rc
= ethtool_set_value_void(dev
, useraddr
,
2657 dev
->ethtool_ops
->set_msglevel
);
2660 rc
= ethtool_get_eee(dev
, useraddr
);
2663 rc
= ethtool_set_eee(dev
, useraddr
);
2665 case ETHTOOL_NWAY_RST
:
2666 rc
= ethtool_nway_reset(dev
);
2669 rc
= ethtool_get_link(dev
, useraddr
);
2671 case ETHTOOL_GEEPROM
:
2672 rc
= ethtool_get_eeprom(dev
, useraddr
);
2674 case ETHTOOL_SEEPROM
:
2675 rc
= ethtool_set_eeprom(dev
, useraddr
);
2677 case ETHTOOL_GCOALESCE
:
2678 rc
= ethtool_get_coalesce(dev
, useraddr
);
2680 case ETHTOOL_SCOALESCE
:
2681 rc
= ethtool_set_coalesce(dev
, useraddr
);
2683 case ETHTOOL_GRINGPARAM
:
2684 rc
= ethtool_get_ringparam(dev
, useraddr
);
2686 case ETHTOOL_SRINGPARAM
:
2687 rc
= ethtool_set_ringparam(dev
, useraddr
);
2689 case ETHTOOL_GPAUSEPARAM
:
2690 rc
= ethtool_get_pauseparam(dev
, useraddr
);
2692 case ETHTOOL_SPAUSEPARAM
:
2693 rc
= ethtool_set_pauseparam(dev
, useraddr
);
2696 rc
= ethtool_self_test(dev
, useraddr
);
2698 case ETHTOOL_GSTRINGS
:
2699 rc
= ethtool_get_strings(dev
, useraddr
);
2701 case ETHTOOL_PHYS_ID
:
2702 rc
= ethtool_phys_id(dev
, useraddr
);
2704 case ETHTOOL_GSTATS
:
2705 rc
= ethtool_get_stats(dev
, useraddr
);
2707 case ETHTOOL_GPERMADDR
:
2708 rc
= ethtool_get_perm_addr(dev
, useraddr
);
2710 case ETHTOOL_GFLAGS
:
2711 rc
= ethtool_get_value(dev
, useraddr
, ethcmd
,
2712 __ethtool_get_flags
);
2714 case ETHTOOL_SFLAGS
:
2715 rc
= ethtool_set_value(dev
, useraddr
, __ethtool_set_flags
);
2717 case ETHTOOL_GPFLAGS
:
2718 rc
= ethtool_get_value(dev
, useraddr
, ethcmd
,
2719 dev
->ethtool_ops
->get_priv_flags
);
2721 case ETHTOOL_SPFLAGS
:
2722 rc
= ethtool_set_value(dev
, useraddr
,
2723 dev
->ethtool_ops
->set_priv_flags
);
2726 case ETHTOOL_GRXRINGS
:
2727 case ETHTOOL_GRXCLSRLCNT
:
2728 case ETHTOOL_GRXCLSRULE
:
2729 case ETHTOOL_GRXCLSRLALL
:
2730 rc
= ethtool_get_rxnfc(dev
, ethcmd
, useraddr
);
2733 case ETHTOOL_SRXCLSRLDEL
:
2734 case ETHTOOL_SRXCLSRLINS
:
2735 rc
= ethtool_set_rxnfc(dev
, ethcmd
, useraddr
);
2737 case ETHTOOL_FLASHDEV
:
2738 rc
= ethtool_flash_device(dev
, useraddr
);
2741 rc
= ethtool_reset(dev
, useraddr
);
2743 case ETHTOOL_GSSET_INFO
:
2744 rc
= ethtool_get_sset_info(dev
, useraddr
);
2746 case ETHTOOL_GRXFHINDIR
:
2747 rc
= ethtool_get_rxfh_indir(dev
, useraddr
);
2749 case ETHTOOL_SRXFHINDIR
:
2750 rc
= ethtool_set_rxfh_indir(dev
, useraddr
);
2753 rc
= ethtool_get_rxfh(dev
, useraddr
);
2756 rc
= ethtool_set_rxfh(dev
, useraddr
);
2758 case ETHTOOL_GFEATURES
:
2759 rc
= ethtool_get_features(dev
, useraddr
);
2761 case ETHTOOL_SFEATURES
:
2762 rc
= ethtool_set_features(dev
, useraddr
);
2764 case ETHTOOL_GTXCSUM
:
2765 case ETHTOOL_GRXCSUM
:
2770 rc
= ethtool_get_one_feature(dev
, useraddr
, ethcmd
);
2772 case ETHTOOL_STXCSUM
:
2773 case ETHTOOL_SRXCSUM
:
2778 rc
= ethtool_set_one_feature(dev
, useraddr
, ethcmd
);
2780 case ETHTOOL_GCHANNELS
:
2781 rc
= ethtool_get_channels(dev
, useraddr
);
2783 case ETHTOOL_SCHANNELS
:
2784 rc
= ethtool_set_channels(dev
, useraddr
);
2786 case ETHTOOL_SET_DUMP
:
2787 rc
= ethtool_set_dump(dev
, useraddr
);
2789 case ETHTOOL_GET_DUMP_FLAG
:
2790 rc
= ethtool_get_dump_flag(dev
, useraddr
);
2792 case ETHTOOL_GET_DUMP_DATA
:
2793 rc
= ethtool_get_dump_data(dev
, useraddr
);
2795 case ETHTOOL_GET_TS_INFO
:
2796 rc
= ethtool_get_ts_info(dev
, useraddr
);
2798 case ETHTOOL_GMODULEINFO
:
2799 rc
= ethtool_get_module_info(dev
, useraddr
);
2801 case ETHTOOL_GMODULEEEPROM
:
2802 rc
= ethtool_get_module_eeprom(dev
, useraddr
);
2804 case ETHTOOL_GTUNABLE
:
2805 rc
= ethtool_get_tunable(dev
, useraddr
);
2807 case ETHTOOL_STUNABLE
:
2808 rc
= ethtool_set_tunable(dev
, useraddr
);
2810 case ETHTOOL_GPHYSTATS
:
2811 rc
= ethtool_get_phy_stats(dev
, useraddr
);
2813 case ETHTOOL_PERQUEUE
:
2814 rc
= ethtool_set_per_queue(dev
, useraddr
, sub_cmd
);
2816 case ETHTOOL_GLINKSETTINGS
:
2817 rc
= ethtool_get_link_ksettings(dev
, useraddr
);
2819 case ETHTOOL_SLINKSETTINGS
:
2820 rc
= ethtool_set_link_ksettings(dev
, useraddr
);
2822 case ETHTOOL_PHY_GTUNABLE
:
2823 rc
= get_phy_tunable(dev
, useraddr
);
2825 case ETHTOOL_PHY_STUNABLE
:
2826 rc
= set_phy_tunable(dev
, useraddr
);
2828 case ETHTOOL_GFECPARAM
:
2829 rc
= ethtool_get_fecparam(dev
, useraddr
);
2831 case ETHTOOL_SFECPARAM
:
2832 rc
= ethtool_set_fecparam(dev
, useraddr
);
2838 if (dev
->ethtool_ops
->complete
)
2839 dev
->ethtool_ops
->complete(dev
);
2841 if (old_features
!= dev
->features
)
2842 netdev_features_change(dev
);
2847 struct ethtool_rx_flow_key
{
2848 struct flow_dissector_key_basic basic
;
2850 struct flow_dissector_key_ipv4_addrs ipv4
;
2851 struct flow_dissector_key_ipv6_addrs ipv6
;
2853 struct flow_dissector_key_ports tp
;
2854 struct flow_dissector_key_ip ip
;
2855 struct flow_dissector_key_vlan vlan
;
2856 struct flow_dissector_key_eth_addrs eth_addrs
;
2857 } __aligned(BITS_PER_LONG
/ 8); /* Ensure that we can do comparisons as longs. */
2859 struct ethtool_rx_flow_match
{
2860 struct flow_dissector dissector
;
2861 struct ethtool_rx_flow_key key
;
2862 struct ethtool_rx_flow_key mask
;
2865 struct ethtool_rx_flow_rule
*
2866 ethtool_rx_flow_rule_create(const struct ethtool_rx_flow_spec_input
*input
)
2868 const struct ethtool_rx_flow_spec
*fs
= input
->fs
;
2869 static struct in6_addr zero_addr
= {};
2870 struct ethtool_rx_flow_match
*match
;
2871 struct ethtool_rx_flow_rule
*flow
;
2872 struct flow_action_entry
*act
;
2874 flow
= kzalloc(sizeof(struct ethtool_rx_flow_rule
) +
2875 sizeof(struct ethtool_rx_flow_match
), GFP_KERNEL
);
2877 return ERR_PTR(-ENOMEM
);
2879 /* ethtool_rx supports only one single action per rule. */
2880 flow
->rule
= flow_rule_alloc(1);
2883 return ERR_PTR(-ENOMEM
);
2886 match
= (struct ethtool_rx_flow_match
*)flow
->priv
;
2887 flow
->rule
->match
.dissector
= &match
->dissector
;
2888 flow
->rule
->match
.mask
= &match
->mask
;
2889 flow
->rule
->match
.key
= &match
->key
;
2891 match
->mask
.basic
.n_proto
= htons(0xffff);
2893 switch (fs
->flow_type
& ~(FLOW_EXT
| FLOW_MAC_EXT
| FLOW_RSS
)) {
2895 const struct ethhdr
*ether_spec
, *ether_m_spec
;
2897 ether_spec
= &fs
->h_u
.ether_spec
;
2898 ether_m_spec
= &fs
->m_u
.ether_spec
;
2900 if (!is_zero_ether_addr(ether_m_spec
->h_source
)) {
2901 ether_addr_copy(match
->key
.eth_addrs
.src
,
2902 ether_spec
->h_source
);
2903 ether_addr_copy(match
->mask
.eth_addrs
.src
,
2904 ether_m_spec
->h_source
);
2906 if (!is_zero_ether_addr(ether_m_spec
->h_dest
)) {
2907 ether_addr_copy(match
->key
.eth_addrs
.dst
,
2908 ether_spec
->h_dest
);
2909 ether_addr_copy(match
->mask
.eth_addrs
.dst
,
2910 ether_m_spec
->h_dest
);
2912 if (ether_m_spec
->h_proto
) {
2913 match
->key
.basic
.n_proto
= ether_spec
->h_proto
;
2914 match
->mask
.basic
.n_proto
= ether_m_spec
->h_proto
;
2920 const struct ethtool_tcpip4_spec
*v4_spec
, *v4_m_spec
;
2922 match
->key
.basic
.n_proto
= htons(ETH_P_IP
);
2924 v4_spec
= &fs
->h_u
.tcp_ip4_spec
;
2925 v4_m_spec
= &fs
->m_u
.tcp_ip4_spec
;
2927 if (v4_m_spec
->ip4src
) {
2928 match
->key
.ipv4
.src
= v4_spec
->ip4src
;
2929 match
->mask
.ipv4
.src
= v4_m_spec
->ip4src
;
2931 if (v4_m_spec
->ip4dst
) {
2932 match
->key
.ipv4
.dst
= v4_spec
->ip4dst
;
2933 match
->mask
.ipv4
.dst
= v4_m_spec
->ip4dst
;
2935 if (v4_m_spec
->ip4src
||
2936 v4_m_spec
->ip4dst
) {
2937 match
->dissector
.used_keys
|=
2938 BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS
);
2939 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_IPV4_ADDRS
] =
2940 offsetof(struct ethtool_rx_flow_key
, ipv4
);
2942 if (v4_m_spec
->psrc
) {
2943 match
->key
.tp
.src
= v4_spec
->psrc
;
2944 match
->mask
.tp
.src
= v4_m_spec
->psrc
;
2946 if (v4_m_spec
->pdst
) {
2947 match
->key
.tp
.dst
= v4_spec
->pdst
;
2948 match
->mask
.tp
.dst
= v4_m_spec
->pdst
;
2950 if (v4_m_spec
->psrc
||
2952 match
->dissector
.used_keys
|=
2953 BIT(FLOW_DISSECTOR_KEY_PORTS
);
2954 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_PORTS
] =
2955 offsetof(struct ethtool_rx_flow_key
, tp
);
2957 if (v4_m_spec
->tos
) {
2958 match
->key
.ip
.tos
= v4_spec
->tos
;
2959 match
->mask
.ip
.tos
= v4_m_spec
->tos
;
2960 match
->dissector
.used_keys
|=
2961 BIT(FLOW_DISSECTOR_KEY_IP
);
2962 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_IP
] =
2963 offsetof(struct ethtool_rx_flow_key
, ip
);
2969 const struct ethtool_tcpip6_spec
*v6_spec
, *v6_m_spec
;
2971 match
->key
.basic
.n_proto
= htons(ETH_P_IPV6
);
2973 v6_spec
= &fs
->h_u
.tcp_ip6_spec
;
2974 v6_m_spec
= &fs
->m_u
.tcp_ip6_spec
;
2975 if (memcmp(v6_m_spec
->ip6src
, &zero_addr
, sizeof(zero_addr
))) {
2976 memcpy(&match
->key
.ipv6
.src
, v6_spec
->ip6src
,
2977 sizeof(match
->key
.ipv6
.src
));
2978 memcpy(&match
->mask
.ipv6
.src
, v6_m_spec
->ip6src
,
2979 sizeof(match
->mask
.ipv6
.src
));
2981 if (memcmp(v6_m_spec
->ip6dst
, &zero_addr
, sizeof(zero_addr
))) {
2982 memcpy(&match
->key
.ipv6
.dst
, v6_spec
->ip6dst
,
2983 sizeof(match
->key
.ipv6
.dst
));
2984 memcpy(&match
->mask
.ipv6
.dst
, v6_m_spec
->ip6dst
,
2985 sizeof(match
->mask
.ipv6
.dst
));
2987 if (memcmp(v6_m_spec
->ip6src
, &zero_addr
, sizeof(zero_addr
)) ||
2988 memcmp(v6_m_spec
->ip6src
, &zero_addr
, sizeof(zero_addr
))) {
2989 match
->dissector
.used_keys
|=
2990 BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS
);
2991 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_IPV6_ADDRS
] =
2992 offsetof(struct ethtool_rx_flow_key
, ipv6
);
2994 if (v6_m_spec
->psrc
) {
2995 match
->key
.tp
.src
= v6_spec
->psrc
;
2996 match
->mask
.tp
.src
= v6_m_spec
->psrc
;
2998 if (v6_m_spec
->pdst
) {
2999 match
->key
.tp
.dst
= v6_spec
->pdst
;
3000 match
->mask
.tp
.dst
= v6_m_spec
->pdst
;
3002 if (v6_m_spec
->psrc
||
3004 match
->dissector
.used_keys
|=
3005 BIT(FLOW_DISSECTOR_KEY_PORTS
);
3006 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_PORTS
] =
3007 offsetof(struct ethtool_rx_flow_key
, tp
);
3009 if (v6_m_spec
->tclass
) {
3010 match
->key
.ip
.tos
= v6_spec
->tclass
;
3011 match
->mask
.ip
.tos
= v6_m_spec
->tclass
;
3012 match
->dissector
.used_keys
|=
3013 BIT(FLOW_DISSECTOR_KEY_IP
);
3014 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_IP
] =
3015 offsetof(struct ethtool_rx_flow_key
, ip
);
3020 ethtool_rx_flow_rule_destroy(flow
);
3021 return ERR_PTR(-EINVAL
);
3024 switch (fs
->flow_type
& ~(FLOW_EXT
| FLOW_MAC_EXT
| FLOW_RSS
)) {
3027 match
->key
.basic
.ip_proto
= IPPROTO_TCP
;
3031 match
->key
.basic
.ip_proto
= IPPROTO_UDP
;
3034 match
->mask
.basic
.ip_proto
= 0xff;
3036 match
->dissector
.used_keys
|= BIT(FLOW_DISSECTOR_KEY_BASIC
);
3037 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_BASIC
] =
3038 offsetof(struct ethtool_rx_flow_key
, basic
);
3040 if (fs
->flow_type
& FLOW_EXT
) {
3041 const struct ethtool_flow_ext
*ext_h_spec
= &fs
->h_ext
;
3042 const struct ethtool_flow_ext
*ext_m_spec
= &fs
->m_ext
;
3044 if (ext_m_spec
->vlan_etype
) {
3045 match
->key
.vlan
.vlan_tpid
= ext_h_spec
->vlan_etype
;
3046 match
->mask
.vlan
.vlan_tpid
= ext_m_spec
->vlan_etype
;
3049 if (ext_m_spec
->vlan_tci
) {
3050 match
->key
.vlan
.vlan_id
=
3051 ntohs(ext_h_spec
->vlan_tci
) & 0x0fff;
3052 match
->mask
.vlan
.vlan_id
=
3053 ntohs(ext_m_spec
->vlan_tci
) & 0x0fff;
3055 match
->key
.vlan
.vlan_dei
=
3056 !!(ext_h_spec
->vlan_tci
& htons(0x1000));
3057 match
->mask
.vlan
.vlan_dei
=
3058 !!(ext_m_spec
->vlan_tci
& htons(0x1000));
3060 match
->key
.vlan
.vlan_priority
=
3061 (ntohs(ext_h_spec
->vlan_tci
) & 0xe000) >> 13;
3062 match
->mask
.vlan
.vlan_priority
=
3063 (ntohs(ext_m_spec
->vlan_tci
) & 0xe000) >> 13;
3066 if (ext_m_spec
->vlan_etype
||
3067 ext_m_spec
->vlan_tci
) {
3068 match
->dissector
.used_keys
|=
3069 BIT(FLOW_DISSECTOR_KEY_VLAN
);
3070 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_VLAN
] =
3071 offsetof(struct ethtool_rx_flow_key
, vlan
);
3074 if (fs
->flow_type
& FLOW_MAC_EXT
) {
3075 const struct ethtool_flow_ext
*ext_h_spec
= &fs
->h_ext
;
3076 const struct ethtool_flow_ext
*ext_m_spec
= &fs
->m_ext
;
3078 memcpy(match
->key
.eth_addrs
.dst
, ext_h_spec
->h_dest
,
3080 memcpy(match
->mask
.eth_addrs
.dst
, ext_m_spec
->h_dest
,
3083 match
->dissector
.used_keys
|=
3084 BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS
);
3085 match
->dissector
.offset
[FLOW_DISSECTOR_KEY_ETH_ADDRS
] =
3086 offsetof(struct ethtool_rx_flow_key
, eth_addrs
);
3089 act
= &flow
->rule
->action
.entries
[0];
3090 switch (fs
->ring_cookie
) {
3091 case RX_CLS_FLOW_DISC
:
3092 act
->id
= FLOW_ACTION_DROP
;
3094 case RX_CLS_FLOW_WAKE
:
3095 act
->id
= FLOW_ACTION_WAKE
;
3098 act
->id
= FLOW_ACTION_QUEUE
;
3099 if (fs
->flow_type
& FLOW_RSS
)
3100 act
->queue
.ctx
= input
->rss_ctx
;
3102 act
->queue
.vf
= ethtool_get_flow_spec_ring_vf(fs
->ring_cookie
);
3103 act
->queue
.index
= ethtool_get_flow_spec_ring(fs
->ring_cookie
);
3109 EXPORT_SYMBOL(ethtool_rx_flow_rule_create
);
3111 void ethtool_rx_flow_rule_destroy(struct ethtool_rx_flow_rule
*flow
)
3116 EXPORT_SYMBOL(ethtool_rx_flow_rule_destroy
);