forked from Minki/linux
fce55922f5
When physical identification of an adapter is done by toggling the mechanism on and off through software utilizing the set_phys_id operation, it is done with a fixed duration for both on and off states. Some drivers may want to set a custom duration for the on/off intervals. This patch changes the API so the return code from the driver's entry point when it is called with ETHTOOL_ID_ACTIVE can specify the frequency at which to cycle the on/off states, and updates the drivers that have already been converted to use the new set_phys_id and use the synchronous method for identifying an adapter. The physical identification frequency set in the updated drivers is based on how it was done prior to the introduction of set_phys_id. Compile tested only. Also fixes a compiler warning in sfc. v2: drivers do not return -EINVAL for ETHOOL_ID_ACTIVE v3: fold patchset into single patch and cleanup per Ben's feedback Signed-off-by: Bruce Allan <bruce.w.allan@intel.com> Cc: Ben Hutchings <bhutchings@solarflare.com> Cc: Sathya Perla <sathya.perla@emulex.com> Cc: Subbu Seetharaman <subbu.seetharaman@emulex.com> Cc: Ajit Khaparde <ajit.khaparde@emulex.com> Cc: Michael Chan <mchan@broadcom.com> Cc: Eilon Greenstein <eilong@broadcom.com> Cc: Divy Le Ray <divy@chelsio.com> Cc: Don Fry <pcnet32@frontier.com> Cc: Jon Mason <jdmason@kudzu.us> Cc: Solarflare linux maintainers <linux-net-drivers@solarflare.com> Cc: Steve Hodgson <shodgson@solarflare.com> Cc: Stephen Hemminger <shemminger@linux-foundation.org> Cc: Matt Carlson <mcarlson@broadcom.com> Acked-by: Jon Mason <jdmason@kudzu.us> Acked-by: Ben Hutchings <bhutchings@solarflare.com> Signed-off-by: David S. Miller <davem@davemloft.net>
2058 lines
50 KiB
C
2058 lines
50 KiB
C
/*
|
|
* net/core/ethtool.c - Ethtool ioctl handler
|
|
* Copyright (c) 2003 Matthew Wilcox <matthew@wil.cx>
|
|
*
|
|
* This file is where we call all the ethtool_ops commands to get
|
|
* the information ethtool needs.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/capability.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/ethtool.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/vmalloc.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/rtnetlink.h>
|
|
#include <linux/sched.h>
|
|
|
|
/*
|
|
* Some useful ethtool_ops methods that're device independent.
|
|
* If we find that all drivers want to do the same thing here,
|
|
* we can turn these into dev_() function calls.
|
|
*/
|
|
|
|
u32 ethtool_op_get_link(struct net_device *dev)
|
|
{
|
|
return netif_carrier_ok(dev) ? 1 : 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_get_link);
|
|
|
|
u32 ethtool_op_get_tx_csum(struct net_device *dev)
|
|
{
|
|
return (dev->features & NETIF_F_ALL_CSUM) != 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_get_tx_csum);
|
|
|
|
int ethtool_op_set_tx_csum(struct net_device *dev, u32 data)
|
|
{
|
|
if (data)
|
|
dev->features |= NETIF_F_IP_CSUM;
|
|
else
|
|
dev->features &= ~NETIF_F_IP_CSUM;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_tx_csum);
|
|
|
|
int ethtool_op_set_tx_hw_csum(struct net_device *dev, u32 data)
|
|
{
|
|
if (data)
|
|
dev->features |= NETIF_F_HW_CSUM;
|
|
else
|
|
dev->features &= ~NETIF_F_HW_CSUM;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_tx_hw_csum);
|
|
|
|
int ethtool_op_set_tx_ipv6_csum(struct net_device *dev, u32 data)
|
|
{
|
|
if (data)
|
|
dev->features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
|
|
else
|
|
dev->features &= ~(NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_tx_ipv6_csum);
|
|
|
|
u32 ethtool_op_get_sg(struct net_device *dev)
|
|
{
|
|
return (dev->features & NETIF_F_SG) != 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_get_sg);
|
|
|
|
int ethtool_op_set_sg(struct net_device *dev, u32 data)
|
|
{
|
|
if (data)
|
|
dev->features |= NETIF_F_SG;
|
|
else
|
|
dev->features &= ~NETIF_F_SG;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_sg);
|
|
|
|
u32 ethtool_op_get_tso(struct net_device *dev)
|
|
{
|
|
return (dev->features & NETIF_F_TSO) != 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_get_tso);
|
|
|
|
int ethtool_op_set_tso(struct net_device *dev, u32 data)
|
|
{
|
|
if (data)
|
|
dev->features |= NETIF_F_TSO;
|
|
else
|
|
dev->features &= ~NETIF_F_TSO;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_tso);
|
|
|
|
u32 ethtool_op_get_ufo(struct net_device *dev)
|
|
{
|
|
return (dev->features & NETIF_F_UFO) != 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_get_ufo);
|
|
|
|
int ethtool_op_set_ufo(struct net_device *dev, u32 data)
|
|
{
|
|
if (data)
|
|
dev->features |= NETIF_F_UFO;
|
|
else
|
|
dev->features &= ~NETIF_F_UFO;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_ufo);
|
|
|
|
/* the following list of flags are the same as their associated
|
|
* NETIF_F_xxx values in include/linux/netdevice.h
|
|
*/
|
|
static const u32 flags_dup_features =
|
|
(ETH_FLAG_LRO | ETH_FLAG_RXVLAN | ETH_FLAG_TXVLAN | ETH_FLAG_NTUPLE |
|
|
ETH_FLAG_RXHASH);
|
|
|
|
u32 ethtool_op_get_flags(struct net_device *dev)
|
|
{
|
|
/* in the future, this function will probably contain additional
|
|
* handling for flags which are not so easily handled
|
|
* by a simple masking operation
|
|
*/
|
|
|
|
return dev->features & flags_dup_features;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_get_flags);
|
|
|
|
/* Check if device can enable (or disable) particular feature coded in "data"
|
|
* argument. Flags "supported" describe features that can be toggled by device.
|
|
* If feature can not be toggled, it state (enabled or disabled) must match
|
|
* hardcoded device features state, otherwise flags are marked as invalid.
|
|
*/
|
|
bool ethtool_invalid_flags(struct net_device *dev, u32 data, u32 supported)
|
|
{
|
|
u32 features = dev->features & flags_dup_features;
|
|
/* "data" can contain only flags_dup_features bits,
|
|
* see __ethtool_set_flags */
|
|
|
|
return (features & ~supported) != (data & ~supported);
|
|
}
|
|
EXPORT_SYMBOL(ethtool_invalid_flags);
|
|
|
|
int ethtool_op_set_flags(struct net_device *dev, u32 data, u32 supported)
|
|
{
|
|
if (ethtool_invalid_flags(dev, data, supported))
|
|
return -EINVAL;
|
|
|
|
dev->features = ((dev->features & ~flags_dup_features) |
|
|
(data & flags_dup_features));
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_op_set_flags);
|
|
|
|
void ethtool_ntuple_flush(struct net_device *dev)
|
|
{
|
|
struct ethtool_rx_ntuple_flow_spec_container *fsc, *f;
|
|
|
|
list_for_each_entry_safe(fsc, f, &dev->ethtool_ntuple_list.list, list) {
|
|
list_del(&fsc->list);
|
|
kfree(fsc);
|
|
}
|
|
dev->ethtool_ntuple_list.count = 0;
|
|
}
|
|
EXPORT_SYMBOL(ethtool_ntuple_flush);
|
|
|
|
/* Handlers for each ethtool command */
|
|
|
|
#define ETHTOOL_DEV_FEATURE_WORDS 1
|
|
|
|
static void ethtool_get_features_compat(struct net_device *dev,
|
|
struct ethtool_get_features_block *features)
|
|
{
|
|
if (!dev->ethtool_ops)
|
|
return;
|
|
|
|
/* getting RX checksum */
|
|
if (dev->ethtool_ops->get_rx_csum)
|
|
if (dev->ethtool_ops->get_rx_csum(dev))
|
|
features[0].active |= NETIF_F_RXCSUM;
|
|
|
|
/* mark legacy-changeable features */
|
|
if (dev->ethtool_ops->set_sg)
|
|
features[0].available |= NETIF_F_SG;
|
|
if (dev->ethtool_ops->set_tx_csum)
|
|
features[0].available |= NETIF_F_ALL_CSUM;
|
|
if (dev->ethtool_ops->set_tso)
|
|
features[0].available |= NETIF_F_ALL_TSO;
|
|
if (dev->ethtool_ops->set_rx_csum)
|
|
features[0].available |= NETIF_F_RXCSUM;
|
|
if (dev->ethtool_ops->set_flags)
|
|
features[0].available |= flags_dup_features;
|
|
}
|
|
|
|
static int ethtool_set_feature_compat(struct net_device *dev,
|
|
int (*legacy_set)(struct net_device *, u32),
|
|
struct ethtool_set_features_block *features, u32 mask)
|
|
{
|
|
u32 do_set;
|
|
|
|
if (!legacy_set)
|
|
return 0;
|
|
|
|
if (!(features[0].valid & mask))
|
|
return 0;
|
|
|
|
features[0].valid &= ~mask;
|
|
|
|
do_set = !!(features[0].requested & mask);
|
|
|
|
if (legacy_set(dev, do_set) < 0)
|
|
netdev_info(dev,
|
|
"Legacy feature change (%s) failed for 0x%08x\n",
|
|
do_set ? "set" : "clear", mask);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int ethtool_set_features_compat(struct net_device *dev,
|
|
struct ethtool_set_features_block *features)
|
|
{
|
|
int compat;
|
|
|
|
if (!dev->ethtool_ops)
|
|
return 0;
|
|
|
|
compat = ethtool_set_feature_compat(dev, dev->ethtool_ops->set_sg,
|
|
features, NETIF_F_SG);
|
|
compat |= ethtool_set_feature_compat(dev, dev->ethtool_ops->set_tx_csum,
|
|
features, NETIF_F_ALL_CSUM);
|
|
compat |= ethtool_set_feature_compat(dev, dev->ethtool_ops->set_tso,
|
|
features, NETIF_F_ALL_TSO);
|
|
compat |= ethtool_set_feature_compat(dev, dev->ethtool_ops->set_rx_csum,
|
|
features, NETIF_F_RXCSUM);
|
|
compat |= ethtool_set_feature_compat(dev, dev->ethtool_ops->set_flags,
|
|
features, flags_dup_features);
|
|
|
|
return compat;
|
|
}
|
|
|
|
static int ethtool_get_features(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_gfeatures cmd = {
|
|
.cmd = ETHTOOL_GFEATURES,
|
|
.size = ETHTOOL_DEV_FEATURE_WORDS,
|
|
};
|
|
struct ethtool_get_features_block features[ETHTOOL_DEV_FEATURE_WORDS] = {
|
|
{
|
|
.available = dev->hw_features,
|
|
.requested = dev->wanted_features,
|
|
.active = dev->features,
|
|
.never_changed = NETIF_F_NEVER_CHANGE,
|
|
},
|
|
};
|
|
u32 __user *sizeaddr;
|
|
u32 copy_size;
|
|
|
|
ethtool_get_features_compat(dev, features);
|
|
|
|
sizeaddr = useraddr + offsetof(struct ethtool_gfeatures, size);
|
|
if (get_user(copy_size, sizeaddr))
|
|
return -EFAULT;
|
|
|
|
if (copy_size > ETHTOOL_DEV_FEATURE_WORDS)
|
|
copy_size = ETHTOOL_DEV_FEATURE_WORDS;
|
|
|
|
if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
|
|
return -EFAULT;
|
|
useraddr += sizeof(cmd);
|
|
if (copy_to_user(useraddr, features, copy_size * sizeof(*features)))
|
|
return -EFAULT;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_features(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_sfeatures cmd;
|
|
struct ethtool_set_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
|
|
int ret = 0;
|
|
|
|
if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
|
|
return -EFAULT;
|
|
useraddr += sizeof(cmd);
|
|
|
|
if (cmd.size != ETHTOOL_DEV_FEATURE_WORDS)
|
|
return -EINVAL;
|
|
|
|
if (copy_from_user(features, useraddr, sizeof(features)))
|
|
return -EFAULT;
|
|
|
|
if (features[0].valid & ~NETIF_F_ETHTOOL_BITS)
|
|
return -EINVAL;
|
|
|
|
if (ethtool_set_features_compat(dev, features))
|
|
ret |= ETHTOOL_F_COMPAT;
|
|
|
|
if (features[0].valid & ~dev->hw_features) {
|
|
features[0].valid &= dev->hw_features;
|
|
ret |= ETHTOOL_F_UNSUPPORTED;
|
|
}
|
|
|
|
dev->wanted_features &= ~features[0].valid;
|
|
dev->wanted_features |= features[0].valid & features[0].requested;
|
|
__netdev_update_features(dev);
|
|
|
|
if ((dev->wanted_features ^ dev->features) & features[0].valid)
|
|
ret |= ETHTOOL_F_WISH;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static const char netdev_features_strings[ETHTOOL_DEV_FEATURE_WORDS * 32][ETH_GSTRING_LEN] = {
|
|
/* NETIF_F_SG */ "tx-scatter-gather",
|
|
/* NETIF_F_IP_CSUM */ "tx-checksum-ipv4",
|
|
/* NETIF_F_NO_CSUM */ "tx-checksum-unneeded",
|
|
/* NETIF_F_HW_CSUM */ "tx-checksum-ip-generic",
|
|
/* NETIF_F_IPV6_CSUM */ "tx_checksum-ipv6",
|
|
/* NETIF_F_HIGHDMA */ "highdma",
|
|
/* NETIF_F_FRAGLIST */ "tx-scatter-gather-fraglist",
|
|
/* NETIF_F_HW_VLAN_TX */ "tx-vlan-hw-insert",
|
|
|
|
/* NETIF_F_HW_VLAN_RX */ "rx-vlan-hw-parse",
|
|
/* NETIF_F_HW_VLAN_FILTER */ "rx-vlan-filter",
|
|
/* NETIF_F_VLAN_CHALLENGED */ "vlan-challenged",
|
|
/* NETIF_F_GSO */ "tx-generic-segmentation",
|
|
/* NETIF_F_LLTX */ "tx-lockless",
|
|
/* NETIF_F_NETNS_LOCAL */ "netns-local",
|
|
/* NETIF_F_GRO */ "rx-gro",
|
|
/* NETIF_F_LRO */ "rx-lro",
|
|
|
|
/* NETIF_F_TSO */ "tx-tcp-segmentation",
|
|
/* NETIF_F_UFO */ "tx-udp-fragmentation",
|
|
/* NETIF_F_GSO_ROBUST */ "tx-gso-robust",
|
|
/* NETIF_F_TSO_ECN */ "tx-tcp-ecn-segmentation",
|
|
/* NETIF_F_TSO6 */ "tx-tcp6-segmentation",
|
|
/* NETIF_F_FSO */ "tx-fcoe-segmentation",
|
|
"",
|
|
"",
|
|
|
|
/* NETIF_F_FCOE_CRC */ "tx-checksum-fcoe-crc",
|
|
/* NETIF_F_SCTP_CSUM */ "tx-checksum-sctp",
|
|
/* NETIF_F_FCOE_MTU */ "fcoe-mtu",
|
|
/* NETIF_F_NTUPLE */ "rx-ntuple-filter",
|
|
/* NETIF_F_RXHASH */ "rx-hashing",
|
|
/* NETIF_F_RXCSUM */ "rx-checksum",
|
|
/* NETIF_F_NOCACHE_COPY */ "tx-nocache-copy"
|
|
"",
|
|
};
|
|
|
|
static int __ethtool_get_sset_count(struct net_device *dev, int sset)
|
|
{
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
|
|
if (sset == ETH_SS_FEATURES)
|
|
return ARRAY_SIZE(netdev_features_strings);
|
|
|
|
if (ops && ops->get_sset_count && ops->get_strings)
|
|
return ops->get_sset_count(dev, sset);
|
|
else
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
static void __ethtool_get_strings(struct net_device *dev,
|
|
u32 stringset, u8 *data)
|
|
{
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
|
|
if (stringset == ETH_SS_FEATURES)
|
|
memcpy(data, netdev_features_strings,
|
|
sizeof(netdev_features_strings));
|
|
else
|
|
/* ops->get_strings is valid because checked earlier */
|
|
ops->get_strings(dev, stringset, data);
|
|
}
|
|
|
|
static u32 ethtool_get_feature_mask(u32 eth_cmd)
|
|
{
|
|
/* feature masks of legacy discrete ethtool ops */
|
|
|
|
switch (eth_cmd) {
|
|
case ETHTOOL_GTXCSUM:
|
|
case ETHTOOL_STXCSUM:
|
|
return NETIF_F_ALL_CSUM | NETIF_F_SCTP_CSUM;
|
|
case ETHTOOL_GRXCSUM:
|
|
case ETHTOOL_SRXCSUM:
|
|
return NETIF_F_RXCSUM;
|
|
case ETHTOOL_GSG:
|
|
case ETHTOOL_SSG:
|
|
return NETIF_F_SG;
|
|
case ETHTOOL_GTSO:
|
|
case ETHTOOL_STSO:
|
|
return NETIF_F_ALL_TSO;
|
|
case ETHTOOL_GUFO:
|
|
case ETHTOOL_SUFO:
|
|
return NETIF_F_UFO;
|
|
case ETHTOOL_GGSO:
|
|
case ETHTOOL_SGSO:
|
|
return NETIF_F_GSO;
|
|
case ETHTOOL_GGRO:
|
|
case ETHTOOL_SGRO:
|
|
return NETIF_F_GRO;
|
|
default:
|
|
BUG();
|
|
}
|
|
}
|
|
|
|
static void *__ethtool_get_one_feature_actor(struct net_device *dev, u32 ethcmd)
|
|
{
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
|
|
if (!ops)
|
|
return NULL;
|
|
|
|
switch (ethcmd) {
|
|
case ETHTOOL_GTXCSUM:
|
|
return ops->get_tx_csum;
|
|
case ETHTOOL_GRXCSUM:
|
|
return ops->get_rx_csum;
|
|
case ETHTOOL_SSG:
|
|
return ops->get_sg;
|
|
case ETHTOOL_STSO:
|
|
return ops->get_tso;
|
|
case ETHTOOL_SUFO:
|
|
return ops->get_ufo;
|
|
default:
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
static u32 __ethtool_get_rx_csum_oldbug(struct net_device *dev)
|
|
{
|
|
return !!(dev->features & NETIF_F_ALL_CSUM);
|
|
}
|
|
|
|
static int ethtool_get_one_feature(struct net_device *dev,
|
|
char __user *useraddr, u32 ethcmd)
|
|
{
|
|
u32 mask = ethtool_get_feature_mask(ethcmd);
|
|
struct ethtool_value edata = {
|
|
.cmd = ethcmd,
|
|
.data = !!(dev->features & mask),
|
|
};
|
|
|
|
/* compatibility with discrete get_ ops */
|
|
if (!(dev->hw_features & mask)) {
|
|
u32 (*actor)(struct net_device *);
|
|
|
|
actor = __ethtool_get_one_feature_actor(dev, ethcmd);
|
|
|
|
/* bug compatibility with old get_rx_csum */
|
|
if (ethcmd == ETHTOOL_GRXCSUM && !actor)
|
|
actor = __ethtool_get_rx_csum_oldbug;
|
|
|
|
if (actor)
|
|
edata.data = actor(dev);
|
|
}
|
|
|
|
if (copy_to_user(useraddr, &edata, sizeof(edata)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int __ethtool_set_tx_csum(struct net_device *dev, u32 data);
|
|
static int __ethtool_set_rx_csum(struct net_device *dev, u32 data);
|
|
static int __ethtool_set_sg(struct net_device *dev, u32 data);
|
|
static int __ethtool_set_tso(struct net_device *dev, u32 data);
|
|
static int __ethtool_set_ufo(struct net_device *dev, u32 data);
|
|
|
|
static int ethtool_set_one_feature(struct net_device *dev,
|
|
void __user *useraddr, u32 ethcmd)
|
|
{
|
|
struct ethtool_value edata;
|
|
u32 mask;
|
|
|
|
if (copy_from_user(&edata, useraddr, sizeof(edata)))
|
|
return -EFAULT;
|
|
|
|
mask = ethtool_get_feature_mask(ethcmd);
|
|
mask &= dev->hw_features;
|
|
if (mask) {
|
|
if (edata.data)
|
|
dev->wanted_features |= mask;
|
|
else
|
|
dev->wanted_features &= ~mask;
|
|
|
|
__netdev_update_features(dev);
|
|
return 0;
|
|
}
|
|
|
|
/* Driver is not converted to ndo_fix_features or does not
|
|
* support changing this offload. In the latter case it won't
|
|
* have corresponding ethtool_ops field set.
|
|
*
|
|
* Following part is to be removed after all drivers advertise
|
|
* their changeable features in netdev->hw_features and stop
|
|
* using discrete offload setting ops.
|
|
*/
|
|
|
|
switch (ethcmd) {
|
|
case ETHTOOL_STXCSUM:
|
|
return __ethtool_set_tx_csum(dev, edata.data);
|
|
case ETHTOOL_SRXCSUM:
|
|
return __ethtool_set_rx_csum(dev, edata.data);
|
|
case ETHTOOL_SSG:
|
|
return __ethtool_set_sg(dev, edata.data);
|
|
case ETHTOOL_STSO:
|
|
return __ethtool_set_tso(dev, edata.data);
|
|
case ETHTOOL_SUFO:
|
|
return __ethtool_set_ufo(dev, edata.data);
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
}
|
|
|
|
int __ethtool_set_flags(struct net_device *dev, u32 data)
|
|
{
|
|
u32 changed;
|
|
|
|
if (data & ~flags_dup_features)
|
|
return -EINVAL;
|
|
|
|
/* legacy set_flags() op */
|
|
if (dev->ethtool_ops->set_flags) {
|
|
if (unlikely(dev->hw_features & flags_dup_features))
|
|
netdev_warn(dev,
|
|
"driver BUG: mixed hw_features and set_flags()\n");
|
|
return dev->ethtool_ops->set_flags(dev, data);
|
|
}
|
|
|
|
/* allow changing only bits set in hw_features */
|
|
changed = (data ^ dev->wanted_features) & flags_dup_features;
|
|
if (changed & ~dev->hw_features)
|
|
return (changed & dev->hw_features) ? -EINVAL : -EOPNOTSUPP;
|
|
|
|
dev->wanted_features =
|
|
(dev->wanted_features & ~changed) | data;
|
|
|
|
__netdev_update_features(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_cmd cmd = { .cmd = ETHTOOL_GSET };
|
|
int err;
|
|
|
|
if (!dev->ethtool_ops->get_settings)
|
|
return -EOPNOTSUPP;
|
|
|
|
err = dev->ethtool_ops->get_settings(dev, &cmd);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_settings(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_cmd cmd;
|
|
|
|
if (!dev->ethtool_ops->set_settings)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_settings(dev, &cmd);
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_get_drvinfo(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_drvinfo info;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
|
|
memset(&info, 0, sizeof(info));
|
|
info.cmd = ETHTOOL_GDRVINFO;
|
|
if (ops && ops->get_drvinfo) {
|
|
ops->get_drvinfo(dev, &info);
|
|
} else if (dev->dev.parent && dev->dev.parent->driver) {
|
|
strlcpy(info.bus_info, dev_name(dev->dev.parent),
|
|
sizeof(info.bus_info));
|
|
strlcpy(info.driver, dev->dev.parent->driver->name,
|
|
sizeof(info.driver));
|
|
} else {
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
/*
|
|
* this method of obtaining string set info is deprecated;
|
|
* Use ETHTOOL_GSSET_INFO instead.
|
|
*/
|
|
if (ops && ops->get_sset_count) {
|
|
int rc;
|
|
|
|
rc = ops->get_sset_count(dev, ETH_SS_TEST);
|
|
if (rc >= 0)
|
|
info.testinfo_len = rc;
|
|
rc = ops->get_sset_count(dev, ETH_SS_STATS);
|
|
if (rc >= 0)
|
|
info.n_stats = rc;
|
|
rc = ops->get_sset_count(dev, ETH_SS_PRIV_FLAGS);
|
|
if (rc >= 0)
|
|
info.n_priv_flags = rc;
|
|
}
|
|
if (ops && ops->get_regs_len)
|
|
info.regdump_len = ops->get_regs_len(dev);
|
|
if (ops && ops->get_eeprom_len)
|
|
info.eedump_len = ops->get_eeprom_len(dev);
|
|
|
|
if (copy_to_user(useraddr, &info, sizeof(info)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_get_sset_info(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_sset_info info;
|
|
u64 sset_mask;
|
|
int i, idx = 0, n_bits = 0, ret, rc;
|
|
u32 *info_buf = NULL;
|
|
|
|
if (copy_from_user(&info, useraddr, sizeof(info)))
|
|
return -EFAULT;
|
|
|
|
/* store copy of mask, because we zero struct later on */
|
|
sset_mask = info.sset_mask;
|
|
if (!sset_mask)
|
|
return 0;
|
|
|
|
/* calculate size of return buffer */
|
|
n_bits = hweight64(sset_mask);
|
|
|
|
memset(&info, 0, sizeof(info));
|
|
info.cmd = ETHTOOL_GSSET_INFO;
|
|
|
|
info_buf = kzalloc(n_bits * sizeof(u32), GFP_USER);
|
|
if (!info_buf)
|
|
return -ENOMEM;
|
|
|
|
/*
|
|
* fill return buffer based on input bitmask and successful
|
|
* get_sset_count return
|
|
*/
|
|
for (i = 0; i < 64; i++) {
|
|
if (!(sset_mask & (1ULL << i)))
|
|
continue;
|
|
|
|
rc = __ethtool_get_sset_count(dev, i);
|
|
if (rc >= 0) {
|
|
info.sset_mask |= (1ULL << i);
|
|
info_buf[idx++] = rc;
|
|
}
|
|
}
|
|
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, &info, sizeof(info)))
|
|
goto out;
|
|
|
|
useraddr += offsetof(struct ethtool_sset_info, data);
|
|
if (copy_to_user(useraddr, info_buf, idx * sizeof(u32)))
|
|
goto out;
|
|
|
|
ret = 0;
|
|
|
|
out:
|
|
kfree(info_buf);
|
|
return ret;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_set_rxnfc(struct net_device *dev,
|
|
u32 cmd, void __user *useraddr)
|
|
{
|
|
struct ethtool_rxnfc info;
|
|
size_t info_size = sizeof(info);
|
|
|
|
if (!dev->ethtool_ops->set_rxnfc)
|
|
return -EOPNOTSUPP;
|
|
|
|
/* struct ethtool_rxnfc was originally defined for
|
|
* ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
|
|
* members. User-space might still be using that
|
|
* definition. */
|
|
if (cmd == ETHTOOL_SRXFH)
|
|
info_size = (offsetof(struct ethtool_rxnfc, data) +
|
|
sizeof(info.data));
|
|
|
|
if (copy_from_user(&info, useraddr, info_size))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_rxnfc(dev, &info);
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_get_rxnfc(struct net_device *dev,
|
|
u32 cmd, void __user *useraddr)
|
|
{
|
|
struct ethtool_rxnfc info;
|
|
size_t info_size = sizeof(info);
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
int ret;
|
|
void *rule_buf = NULL;
|
|
|
|
if (!ops->get_rxnfc)
|
|
return -EOPNOTSUPP;
|
|
|
|
/* struct ethtool_rxnfc was originally defined for
|
|
* ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
|
|
* members. User-space might still be using that
|
|
* definition. */
|
|
if (cmd == ETHTOOL_GRXFH)
|
|
info_size = (offsetof(struct ethtool_rxnfc, data) +
|
|
sizeof(info.data));
|
|
|
|
if (copy_from_user(&info, useraddr, info_size))
|
|
return -EFAULT;
|
|
|
|
if (info.cmd == ETHTOOL_GRXCLSRLALL) {
|
|
if (info.rule_cnt > 0) {
|
|
if (info.rule_cnt <= KMALLOC_MAX_SIZE / sizeof(u32))
|
|
rule_buf = kzalloc(info.rule_cnt * sizeof(u32),
|
|
GFP_USER);
|
|
if (!rule_buf)
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
|
|
ret = ops->get_rxnfc(dev, &info, rule_buf);
|
|
if (ret < 0)
|
|
goto err_out;
|
|
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, &info, info_size))
|
|
goto err_out;
|
|
|
|
if (rule_buf) {
|
|
useraddr += offsetof(struct ethtool_rxnfc, rule_locs);
|
|
if (copy_to_user(useraddr, rule_buf,
|
|
info.rule_cnt * sizeof(u32)))
|
|
goto err_out;
|
|
}
|
|
ret = 0;
|
|
|
|
err_out:
|
|
kfree(rule_buf);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_get_rxfh_indir(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_rxfh_indir *indir;
|
|
u32 table_size;
|
|
size_t full_size;
|
|
int ret;
|
|
|
|
if (!dev->ethtool_ops->get_rxfh_indir)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&table_size,
|
|
useraddr + offsetof(struct ethtool_rxfh_indir, size),
|
|
sizeof(table_size)))
|
|
return -EFAULT;
|
|
|
|
if (table_size >
|
|
(KMALLOC_MAX_SIZE - sizeof(*indir)) / sizeof(*indir->ring_index))
|
|
return -ENOMEM;
|
|
full_size = sizeof(*indir) + sizeof(*indir->ring_index) * table_size;
|
|
indir = kzalloc(full_size, GFP_USER);
|
|
if (!indir)
|
|
return -ENOMEM;
|
|
|
|
indir->cmd = ETHTOOL_GRXFHINDIR;
|
|
indir->size = table_size;
|
|
ret = dev->ethtool_ops->get_rxfh_indir(dev, indir);
|
|
if (ret)
|
|
goto out;
|
|
|
|
if (copy_to_user(useraddr, indir, full_size))
|
|
ret = -EFAULT;
|
|
|
|
out:
|
|
kfree(indir);
|
|
return ret;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_set_rxfh_indir(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_rxfh_indir *indir;
|
|
u32 table_size;
|
|
size_t full_size;
|
|
int ret;
|
|
|
|
if (!dev->ethtool_ops->set_rxfh_indir)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&table_size,
|
|
useraddr + offsetof(struct ethtool_rxfh_indir, size),
|
|
sizeof(table_size)))
|
|
return -EFAULT;
|
|
|
|
if (table_size >
|
|
(KMALLOC_MAX_SIZE - sizeof(*indir)) / sizeof(*indir->ring_index))
|
|
return -ENOMEM;
|
|
full_size = sizeof(*indir) + sizeof(*indir->ring_index) * table_size;
|
|
indir = kmalloc(full_size, GFP_USER);
|
|
if (!indir)
|
|
return -ENOMEM;
|
|
|
|
if (copy_from_user(indir, useraddr, full_size)) {
|
|
ret = -EFAULT;
|
|
goto out;
|
|
}
|
|
|
|
ret = dev->ethtool_ops->set_rxfh_indir(dev, indir);
|
|
|
|
out:
|
|
kfree(indir);
|
|
return ret;
|
|
}
|
|
|
|
static void __rx_ntuple_filter_add(struct ethtool_rx_ntuple_list *list,
|
|
struct ethtool_rx_ntuple_flow_spec *spec,
|
|
struct ethtool_rx_ntuple_flow_spec_container *fsc)
|
|
{
|
|
|
|
/* don't add filters forever */
|
|
if (list->count >= ETHTOOL_MAX_NTUPLE_LIST_ENTRY) {
|
|
/* free the container */
|
|
kfree(fsc);
|
|
return;
|
|
}
|
|
|
|
/* Copy the whole filter over */
|
|
fsc->fs.flow_type = spec->flow_type;
|
|
memcpy(&fsc->fs.h_u, &spec->h_u, sizeof(spec->h_u));
|
|
memcpy(&fsc->fs.m_u, &spec->m_u, sizeof(spec->m_u));
|
|
|
|
fsc->fs.vlan_tag = spec->vlan_tag;
|
|
fsc->fs.vlan_tag_mask = spec->vlan_tag_mask;
|
|
fsc->fs.data = spec->data;
|
|
fsc->fs.data_mask = spec->data_mask;
|
|
fsc->fs.action = spec->action;
|
|
|
|
/* add to the list */
|
|
list_add_tail_rcu(&fsc->list, &list->list);
|
|
list->count++;
|
|
}
|
|
|
|
/*
|
|
* ethtool does not (or did not) set masks for flow parameters that are
|
|
* not specified, so if both value and mask are 0 then this must be
|
|
* treated as equivalent to a mask with all bits set. Implement that
|
|
* here rather than in drivers.
|
|
*/
|
|
static void rx_ntuple_fix_masks(struct ethtool_rx_ntuple_flow_spec *fs)
|
|
{
|
|
struct ethtool_tcpip4_spec *entry = &fs->h_u.tcp_ip4_spec;
|
|
struct ethtool_tcpip4_spec *mask = &fs->m_u.tcp_ip4_spec;
|
|
|
|
if (fs->flow_type != TCP_V4_FLOW &&
|
|
fs->flow_type != UDP_V4_FLOW &&
|
|
fs->flow_type != SCTP_V4_FLOW)
|
|
return;
|
|
|
|
if (!(entry->ip4src | mask->ip4src))
|
|
mask->ip4src = htonl(0xffffffff);
|
|
if (!(entry->ip4dst | mask->ip4dst))
|
|
mask->ip4dst = htonl(0xffffffff);
|
|
if (!(entry->psrc | mask->psrc))
|
|
mask->psrc = htons(0xffff);
|
|
if (!(entry->pdst | mask->pdst))
|
|
mask->pdst = htons(0xffff);
|
|
if (!(entry->tos | mask->tos))
|
|
mask->tos = 0xff;
|
|
if (!(fs->vlan_tag | fs->vlan_tag_mask))
|
|
fs->vlan_tag_mask = 0xffff;
|
|
if (!(fs->data | fs->data_mask))
|
|
fs->data_mask = 0xffffffffffffffffULL;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_set_rx_ntuple(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_rx_ntuple cmd;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
struct ethtool_rx_ntuple_flow_spec_container *fsc = NULL;
|
|
int ret;
|
|
|
|
if (!ops->set_rx_ntuple)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (!(dev->features & NETIF_F_NTUPLE))
|
|
return -EINVAL;
|
|
|
|
if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
|
|
return -EFAULT;
|
|
|
|
rx_ntuple_fix_masks(&cmd.fs);
|
|
|
|
/*
|
|
* Cache filter in dev struct for GET operation only if
|
|
* the underlying driver doesn't have its own GET operation, and
|
|
* only if the filter was added successfully. First make sure we
|
|
* can allocate the filter, then continue if successful.
|
|
*/
|
|
if (!ops->get_rx_ntuple) {
|
|
fsc = kmalloc(sizeof(*fsc), GFP_ATOMIC);
|
|
if (!fsc)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
ret = ops->set_rx_ntuple(dev, &cmd);
|
|
if (ret) {
|
|
kfree(fsc);
|
|
return ret;
|
|
}
|
|
|
|
if (!ops->get_rx_ntuple)
|
|
__rx_ntuple_filter_add(&dev->ethtool_ntuple_list, &cmd.fs, fsc);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_get_rx_ntuple(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_gstrings gstrings;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
struct ethtool_rx_ntuple_flow_spec_container *fsc;
|
|
u8 *data;
|
|
char *p;
|
|
int ret, i, num_strings = 0;
|
|
|
|
if (!ops->get_sset_count)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
|
|
return -EFAULT;
|
|
|
|
ret = ops->get_sset_count(dev, gstrings.string_set);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
gstrings.len = ret;
|
|
|
|
data = kzalloc(gstrings.len * ETH_GSTRING_LEN, GFP_USER);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
if (ops->get_rx_ntuple) {
|
|
/* driver-specific filter grab */
|
|
ret = ops->get_rx_ntuple(dev, gstrings.string_set, data);
|
|
goto copy;
|
|
}
|
|
|
|
/* default ethtool filter grab */
|
|
i = 0;
|
|
p = (char *)data;
|
|
list_for_each_entry(fsc, &dev->ethtool_ntuple_list.list, list) {
|
|
sprintf(p, "Filter %d:\n", i);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
|
|
switch (fsc->fs.flow_type) {
|
|
case TCP_V4_FLOW:
|
|
sprintf(p, "\tFlow Type: TCP\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case UDP_V4_FLOW:
|
|
sprintf(p, "\tFlow Type: UDP\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case SCTP_V4_FLOW:
|
|
sprintf(p, "\tFlow Type: SCTP\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case AH_ESP_V4_FLOW:
|
|
sprintf(p, "\tFlow Type: AH ESP\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case ESP_V4_FLOW:
|
|
sprintf(p, "\tFlow Type: ESP\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case IP_USER_FLOW:
|
|
sprintf(p, "\tFlow Type: Raw IP\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case IPV4_FLOW:
|
|
sprintf(p, "\tFlow Type: IPv4\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
default:
|
|
sprintf(p, "\tFlow Type: Unknown\n");
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
goto unknown_filter;
|
|
}
|
|
|
|
/* now the rest of the filters */
|
|
switch (fsc->fs.flow_type) {
|
|
case TCP_V4_FLOW:
|
|
case UDP_V4_FLOW:
|
|
case SCTP_V4_FLOW:
|
|
sprintf(p, "\tSrc IP addr: 0x%x\n",
|
|
fsc->fs.h_u.tcp_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tSrc IP mask: 0x%x\n",
|
|
fsc->fs.m_u.tcp_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP addr: 0x%x\n",
|
|
fsc->fs.h_u.tcp_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP mask: 0x%x\n",
|
|
fsc->fs.m_u.tcp_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tSrc Port: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.tcp_ip4_spec.psrc,
|
|
fsc->fs.m_u.tcp_ip4_spec.psrc);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest Port: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.tcp_ip4_spec.pdst,
|
|
fsc->fs.m_u.tcp_ip4_spec.pdst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tTOS: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.tcp_ip4_spec.tos,
|
|
fsc->fs.m_u.tcp_ip4_spec.tos);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case AH_ESP_V4_FLOW:
|
|
case ESP_V4_FLOW:
|
|
sprintf(p, "\tSrc IP addr: 0x%x\n",
|
|
fsc->fs.h_u.ah_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tSrc IP mask: 0x%x\n",
|
|
fsc->fs.m_u.ah_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP addr: 0x%x\n",
|
|
fsc->fs.h_u.ah_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP mask: 0x%x\n",
|
|
fsc->fs.m_u.ah_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tSPI: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.ah_ip4_spec.spi,
|
|
fsc->fs.m_u.ah_ip4_spec.spi);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tTOS: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.ah_ip4_spec.tos,
|
|
fsc->fs.m_u.ah_ip4_spec.tos);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case IP_USER_FLOW:
|
|
sprintf(p, "\tSrc IP addr: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tSrc IP mask: 0x%x\n",
|
|
fsc->fs.m_u.usr_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP addr: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP mask: 0x%x\n",
|
|
fsc->fs.m_u.usr_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
case IPV4_FLOW:
|
|
sprintf(p, "\tSrc IP addr: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tSrc IP mask: 0x%x\n",
|
|
fsc->fs.m_u.usr_ip4_spec.ip4src);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP addr: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tDest IP mask: 0x%x\n",
|
|
fsc->fs.m_u.usr_ip4_spec.ip4dst);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tL4 bytes: 0x%x, mask: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.l4_4_bytes,
|
|
fsc->fs.m_u.usr_ip4_spec.l4_4_bytes);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tTOS: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.tos,
|
|
fsc->fs.m_u.usr_ip4_spec.tos);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tIP Version: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.ip_ver,
|
|
fsc->fs.m_u.usr_ip4_spec.ip_ver);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tProtocol: %d, mask: 0x%x\n",
|
|
fsc->fs.h_u.usr_ip4_spec.proto,
|
|
fsc->fs.m_u.usr_ip4_spec.proto);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
break;
|
|
}
|
|
sprintf(p, "\tVLAN: %d, mask: 0x%x\n",
|
|
fsc->fs.vlan_tag, fsc->fs.vlan_tag_mask);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tUser-defined: 0x%Lx\n", fsc->fs.data);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
sprintf(p, "\tUser-defined mask: 0x%Lx\n", fsc->fs.data_mask);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
if (fsc->fs.action == ETHTOOL_RXNTUPLE_ACTION_DROP)
|
|
sprintf(p, "\tAction: Drop\n");
|
|
else
|
|
sprintf(p, "\tAction: Direct to queue %d\n",
|
|
fsc->fs.action);
|
|
p += ETH_GSTRING_LEN;
|
|
num_strings++;
|
|
unknown_filter:
|
|
i++;
|
|
}
|
|
copy:
|
|
/* indicate to userspace how many strings we actually have */
|
|
gstrings.len = num_strings;
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
|
|
goto out;
|
|
useraddr += sizeof(gstrings);
|
|
if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
|
|
goto out;
|
|
ret = 0;
|
|
|
|
out:
|
|
kfree(data);
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_get_regs(struct net_device *dev, char __user *useraddr)
|
|
{
|
|
struct ethtool_regs regs;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
void *regbuf;
|
|
int reglen, ret;
|
|
|
|
if (!ops->get_regs || !ops->get_regs_len)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(®s, useraddr, sizeof(regs)))
|
|
return -EFAULT;
|
|
|
|
reglen = ops->get_regs_len(dev);
|
|
if (regs.len > reglen)
|
|
regs.len = reglen;
|
|
|
|
regbuf = vzalloc(reglen);
|
|
if (!regbuf)
|
|
return -ENOMEM;
|
|
|
|
ops->get_regs(dev, ®s, regbuf);
|
|
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, ®s, sizeof(regs)))
|
|
goto out;
|
|
useraddr += offsetof(struct ethtool_regs, data);
|
|
if (copy_to_user(useraddr, regbuf, regs.len))
|
|
goto out;
|
|
ret = 0;
|
|
|
|
out:
|
|
vfree(regbuf);
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_reset(struct net_device *dev, char __user *useraddr)
|
|
{
|
|
struct ethtool_value reset;
|
|
int ret;
|
|
|
|
if (!dev->ethtool_ops->reset)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&reset, useraddr, sizeof(reset)))
|
|
return -EFAULT;
|
|
|
|
ret = dev->ethtool_ops->reset(dev, &reset.data);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (copy_to_user(useraddr, &reset, sizeof(reset)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_get_wol(struct net_device *dev, char __user *useraddr)
|
|
{
|
|
struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
|
|
|
|
if (!dev->ethtool_ops->get_wol)
|
|
return -EOPNOTSUPP;
|
|
|
|
dev->ethtool_ops->get_wol(dev, &wol);
|
|
|
|
if (copy_to_user(useraddr, &wol, sizeof(wol)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_wol(struct net_device *dev, char __user *useraddr)
|
|
{
|
|
struct ethtool_wolinfo wol;
|
|
|
|
if (!dev->ethtool_ops->set_wol)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&wol, useraddr, sizeof(wol)))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_wol(dev, &wol);
|
|
}
|
|
|
|
static int ethtool_nway_reset(struct net_device *dev)
|
|
{
|
|
if (!dev->ethtool_ops->nway_reset)
|
|
return -EOPNOTSUPP;
|
|
|
|
return dev->ethtool_ops->nway_reset(dev);
|
|
}
|
|
|
|
static int ethtool_get_link(struct net_device *dev, char __user *useraddr)
|
|
{
|
|
struct ethtool_value edata = { .cmd = ETHTOOL_GLINK };
|
|
|
|
if (!dev->ethtool_ops->get_link)
|
|
return -EOPNOTSUPP;
|
|
|
|
edata.data = netif_running(dev) && dev->ethtool_ops->get_link(dev);
|
|
|
|
if (copy_to_user(useraddr, &edata, sizeof(edata)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_get_eeprom(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_eeprom eeprom;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
void __user *userbuf = useraddr + sizeof(eeprom);
|
|
u32 bytes_remaining;
|
|
u8 *data;
|
|
int ret = 0;
|
|
|
|
if (!ops->get_eeprom || !ops->get_eeprom_len)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
|
|
return -EFAULT;
|
|
|
|
/* Check for wrap and zero */
|
|
if (eeprom.offset + eeprom.len <= eeprom.offset)
|
|
return -EINVAL;
|
|
|
|
/* Check for exceeding total eeprom len */
|
|
if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
|
|
return -EINVAL;
|
|
|
|
data = kmalloc(PAGE_SIZE, GFP_USER);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
bytes_remaining = eeprom.len;
|
|
while (bytes_remaining > 0) {
|
|
eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
|
|
|
|
ret = ops->get_eeprom(dev, &eeprom, data);
|
|
if (ret)
|
|
break;
|
|
if (copy_to_user(userbuf, data, eeprom.len)) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
userbuf += eeprom.len;
|
|
eeprom.offset += eeprom.len;
|
|
bytes_remaining -= eeprom.len;
|
|
}
|
|
|
|
eeprom.len = userbuf - (useraddr + sizeof(eeprom));
|
|
eeprom.offset -= eeprom.len;
|
|
if (copy_to_user(useraddr, &eeprom, sizeof(eeprom)))
|
|
ret = -EFAULT;
|
|
|
|
kfree(data);
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_set_eeprom(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_eeprom eeprom;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
void __user *userbuf = useraddr + sizeof(eeprom);
|
|
u32 bytes_remaining;
|
|
u8 *data;
|
|
int ret = 0;
|
|
|
|
if (!ops->set_eeprom || !ops->get_eeprom_len)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
|
|
return -EFAULT;
|
|
|
|
/* Check for wrap and zero */
|
|
if (eeprom.offset + eeprom.len <= eeprom.offset)
|
|
return -EINVAL;
|
|
|
|
/* Check for exceeding total eeprom len */
|
|
if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
|
|
return -EINVAL;
|
|
|
|
data = kmalloc(PAGE_SIZE, GFP_USER);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
bytes_remaining = eeprom.len;
|
|
while (bytes_remaining > 0) {
|
|
eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
|
|
|
|
if (copy_from_user(data, userbuf, eeprom.len)) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
ret = ops->set_eeprom(dev, &eeprom, data);
|
|
if (ret)
|
|
break;
|
|
userbuf += eeprom.len;
|
|
eeprom.offset += eeprom.len;
|
|
bytes_remaining -= eeprom.len;
|
|
}
|
|
|
|
kfree(data);
|
|
return ret;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_get_coalesce(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_coalesce coalesce = { .cmd = ETHTOOL_GCOALESCE };
|
|
|
|
if (!dev->ethtool_ops->get_coalesce)
|
|
return -EOPNOTSUPP;
|
|
|
|
dev->ethtool_ops->get_coalesce(dev, &coalesce);
|
|
|
|
if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_set_coalesce(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_coalesce coalesce;
|
|
|
|
if (!dev->ethtool_ops->set_coalesce)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&coalesce, useraddr, sizeof(coalesce)))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_coalesce(dev, &coalesce);
|
|
}
|
|
|
|
static int ethtool_get_ringparam(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_ringparam ringparam = { .cmd = ETHTOOL_GRINGPARAM };
|
|
|
|
if (!dev->ethtool_ops->get_ringparam)
|
|
return -EOPNOTSUPP;
|
|
|
|
dev->ethtool_ops->get_ringparam(dev, &ringparam);
|
|
|
|
if (copy_to_user(useraddr, &ringparam, sizeof(ringparam)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_ringparam(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_ringparam ringparam;
|
|
|
|
if (!dev->ethtool_ops->set_ringparam)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&ringparam, useraddr, sizeof(ringparam)))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_ringparam(dev, &ringparam);
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_get_channels(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_channels channels = { .cmd = ETHTOOL_GCHANNELS };
|
|
|
|
if (!dev->ethtool_ops->get_channels)
|
|
return -EOPNOTSUPP;
|
|
|
|
dev->ethtool_ops->get_channels(dev, &channels);
|
|
|
|
if (copy_to_user(useraddr, &channels, sizeof(channels)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_set_channels(struct net_device *dev,
|
|
void __user *useraddr)
|
|
{
|
|
struct ethtool_channels channels;
|
|
|
|
if (!dev->ethtool_ops->set_channels)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&channels, useraddr, sizeof(channels)))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_channels(dev, &channels);
|
|
}
|
|
|
|
static int ethtool_get_pauseparam(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_pauseparam pauseparam = { ETHTOOL_GPAUSEPARAM };
|
|
|
|
if (!dev->ethtool_ops->get_pauseparam)
|
|
return -EOPNOTSUPP;
|
|
|
|
dev->ethtool_ops->get_pauseparam(dev, &pauseparam);
|
|
|
|
if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_pauseparam(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_pauseparam pauseparam;
|
|
|
|
if (!dev->ethtool_ops->set_pauseparam)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam)))
|
|
return -EFAULT;
|
|
|
|
return dev->ethtool_ops->set_pauseparam(dev, &pauseparam);
|
|
}
|
|
|
|
static int __ethtool_set_sg(struct net_device *dev, u32 data)
|
|
{
|
|
int err;
|
|
|
|
if (!dev->ethtool_ops->set_sg)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (data && !(dev->features & NETIF_F_ALL_CSUM))
|
|
return -EINVAL;
|
|
|
|
if (!data && dev->ethtool_ops->set_tso) {
|
|
err = dev->ethtool_ops->set_tso(dev, 0);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (!data && dev->ethtool_ops->set_ufo) {
|
|
err = dev->ethtool_ops->set_ufo(dev, 0);
|
|
if (err)
|
|
return err;
|
|
}
|
|
return dev->ethtool_ops->set_sg(dev, data);
|
|
}
|
|
|
|
static int __ethtool_set_tx_csum(struct net_device *dev, u32 data)
|
|
{
|
|
int err;
|
|
|
|
if (!dev->ethtool_ops->set_tx_csum)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (!data && dev->ethtool_ops->set_sg) {
|
|
err = __ethtool_set_sg(dev, 0);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
return dev->ethtool_ops->set_tx_csum(dev, data);
|
|
}
|
|
|
|
static int __ethtool_set_rx_csum(struct net_device *dev, u32 data)
|
|
{
|
|
if (!dev->ethtool_ops->set_rx_csum)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (!data)
|
|
dev->features &= ~NETIF_F_GRO;
|
|
|
|
return dev->ethtool_ops->set_rx_csum(dev, data);
|
|
}
|
|
|
|
static int __ethtool_set_tso(struct net_device *dev, u32 data)
|
|
{
|
|
if (!dev->ethtool_ops->set_tso)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (data && !(dev->features & NETIF_F_SG))
|
|
return -EINVAL;
|
|
|
|
return dev->ethtool_ops->set_tso(dev, data);
|
|
}
|
|
|
|
static int __ethtool_set_ufo(struct net_device *dev, u32 data)
|
|
{
|
|
if (!dev->ethtool_ops->set_ufo)
|
|
return -EOPNOTSUPP;
|
|
if (data && !(dev->features & NETIF_F_SG))
|
|
return -EINVAL;
|
|
if (data && !((dev->features & NETIF_F_GEN_CSUM) ||
|
|
(dev->features & (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM))
|
|
== (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM)))
|
|
return -EINVAL;
|
|
return dev->ethtool_ops->set_ufo(dev, data);
|
|
}
|
|
|
|
static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
|
|
{
|
|
struct ethtool_test test;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
u64 *data;
|
|
int ret, test_len;
|
|
|
|
if (!ops->self_test || !ops->get_sset_count)
|
|
return -EOPNOTSUPP;
|
|
|
|
test_len = ops->get_sset_count(dev, ETH_SS_TEST);
|
|
if (test_len < 0)
|
|
return test_len;
|
|
WARN_ON(test_len == 0);
|
|
|
|
if (copy_from_user(&test, useraddr, sizeof(test)))
|
|
return -EFAULT;
|
|
|
|
test.len = test_len;
|
|
data = kmalloc(test_len * sizeof(u64), GFP_USER);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
ops->self_test(dev, &test, data);
|
|
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, &test, sizeof(test)))
|
|
goto out;
|
|
useraddr += sizeof(test);
|
|
if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
|
|
goto out;
|
|
ret = 0;
|
|
|
|
out:
|
|
kfree(data);
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_gstrings gstrings;
|
|
u8 *data;
|
|
int ret;
|
|
|
|
if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
|
|
return -EFAULT;
|
|
|
|
ret = __ethtool_get_sset_count(dev, gstrings.string_set);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
gstrings.len = ret;
|
|
|
|
data = kmalloc(gstrings.len * ETH_GSTRING_LEN, GFP_USER);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
__ethtool_get_strings(dev, gstrings.string_set, data);
|
|
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
|
|
goto out;
|
|
useraddr += sizeof(gstrings);
|
|
if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
|
|
goto out;
|
|
ret = 0;
|
|
|
|
out:
|
|
kfree(data);
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_value id;
|
|
static bool busy;
|
|
int rc;
|
|
|
|
if (!dev->ethtool_ops->set_phys_id && !dev->ethtool_ops->phys_id)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (busy)
|
|
return -EBUSY;
|
|
|
|
if (copy_from_user(&id, useraddr, sizeof(id)))
|
|
return -EFAULT;
|
|
|
|
if (!dev->ethtool_ops->set_phys_id)
|
|
/* Do it the old way */
|
|
return dev->ethtool_ops->phys_id(dev, id.data);
|
|
|
|
rc = dev->ethtool_ops->set_phys_id(dev, ETHTOOL_ID_ACTIVE);
|
|
if (rc < 0)
|
|
return rc;
|
|
|
|
/* Drop the RTNL lock while waiting, but prevent reentry or
|
|
* removal of the device.
|
|
*/
|
|
busy = true;
|
|
dev_hold(dev);
|
|
rtnl_unlock();
|
|
|
|
if (rc == 0) {
|
|
/* Driver will handle this itself */
|
|
schedule_timeout_interruptible(
|
|
id.data ? (id.data * HZ) : MAX_SCHEDULE_TIMEOUT);
|
|
} else {
|
|
/* Driver expects to be called at twice the frequency in rc */
|
|
int n = rc * 2, i, interval = HZ / n;
|
|
|
|
/* Count down seconds */
|
|
do {
|
|
/* Count down iterations per second */
|
|
i = n;
|
|
do {
|
|
rtnl_lock();
|
|
rc = dev->ethtool_ops->set_phys_id(dev,
|
|
(i & 1) ? ETHTOOL_ID_OFF : ETHTOOL_ID_ON);
|
|
rtnl_unlock();
|
|
if (rc)
|
|
break;
|
|
schedule_timeout_interruptible(interval);
|
|
} while (!signal_pending(current) && --i != 0);
|
|
} while (!signal_pending(current) &&
|
|
(id.data == 0 || --id.data != 0));
|
|
}
|
|
|
|
rtnl_lock();
|
|
dev_put(dev);
|
|
busy = false;
|
|
|
|
(void)dev->ethtool_ops->set_phys_id(dev, ETHTOOL_ID_INACTIVE);
|
|
return rc;
|
|
}
|
|
|
|
static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_stats stats;
|
|
const struct ethtool_ops *ops = dev->ethtool_ops;
|
|
u64 *data;
|
|
int ret, n_stats;
|
|
|
|
if (!ops->get_ethtool_stats || !ops->get_sset_count)
|
|
return -EOPNOTSUPP;
|
|
|
|
n_stats = ops->get_sset_count(dev, ETH_SS_STATS);
|
|
if (n_stats < 0)
|
|
return n_stats;
|
|
WARN_ON(n_stats == 0);
|
|
|
|
if (copy_from_user(&stats, useraddr, sizeof(stats)))
|
|
return -EFAULT;
|
|
|
|
stats.n_stats = n_stats;
|
|
data = kmalloc(n_stats * sizeof(u64), GFP_USER);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
ops->get_ethtool_stats(dev, &stats, data);
|
|
|
|
ret = -EFAULT;
|
|
if (copy_to_user(useraddr, &stats, sizeof(stats)))
|
|
goto out;
|
|
useraddr += sizeof(stats);
|
|
if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
|
|
goto out;
|
|
ret = 0;
|
|
|
|
out:
|
|
kfree(data);
|
|
return ret;
|
|
}
|
|
|
|
static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
|
|
{
|
|
struct ethtool_perm_addr epaddr;
|
|
|
|
if (copy_from_user(&epaddr, useraddr, sizeof(epaddr)))
|
|
return -EFAULT;
|
|
|
|
if (epaddr.size < dev->addr_len)
|
|
return -ETOOSMALL;
|
|
epaddr.size = dev->addr_len;
|
|
|
|
if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
|
|
return -EFAULT;
|
|
useraddr += sizeof(epaddr);
|
|
if (copy_to_user(useraddr, dev->perm_addr, epaddr.size))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_get_value(struct net_device *dev, char __user *useraddr,
|
|
u32 cmd, u32 (*actor)(struct net_device *))
|
|
{
|
|
struct ethtool_value edata = { .cmd = cmd };
|
|
|
|
if (!actor)
|
|
return -EOPNOTSUPP;
|
|
|
|
edata.data = actor(dev);
|
|
|
|
if (copy_to_user(useraddr, &edata, sizeof(edata)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_value_void(struct net_device *dev, char __user *useraddr,
|
|
void (*actor)(struct net_device *, u32))
|
|
{
|
|
struct ethtool_value edata;
|
|
|
|
if (!actor)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&edata, useraddr, sizeof(edata)))
|
|
return -EFAULT;
|
|
|
|
actor(dev, edata.data);
|
|
return 0;
|
|
}
|
|
|
|
static int ethtool_set_value(struct net_device *dev, char __user *useraddr,
|
|
int (*actor)(struct net_device *, u32))
|
|
{
|
|
struct ethtool_value edata;
|
|
|
|
if (!actor)
|
|
return -EOPNOTSUPP;
|
|
|
|
if (copy_from_user(&edata, useraddr, sizeof(edata)))
|
|
return -EFAULT;
|
|
|
|
return actor(dev, edata.data);
|
|
}
|
|
|
|
static noinline_for_stack int ethtool_flash_device(struct net_device *dev,
|
|
char __user *useraddr)
|
|
{
|
|
struct ethtool_flash efl;
|
|
|
|
if (copy_from_user(&efl, useraddr, sizeof(efl)))
|
|
return -EFAULT;
|
|
|
|
if (!dev->ethtool_ops->flash_device)
|
|
return -EOPNOTSUPP;
|
|
|
|
return dev->ethtool_ops->flash_device(dev, &efl);
|
|
}
|
|
|
|
/* The main entry point in this file. Called from net/core/dev.c */
|
|
|
|
int dev_ethtool(struct net *net, struct ifreq *ifr)
|
|
{
|
|
struct net_device *dev = __dev_get_by_name(net, ifr->ifr_name);
|
|
void __user *useraddr = ifr->ifr_data;
|
|
u32 ethcmd;
|
|
int rc;
|
|
u32 old_features;
|
|
|
|
if (!dev || !netif_device_present(dev))
|
|
return -ENODEV;
|
|
|
|
if (copy_from_user(ðcmd, useraddr, sizeof(ethcmd)))
|
|
return -EFAULT;
|
|
|
|
if (!dev->ethtool_ops) {
|
|
/* ETHTOOL_GDRVINFO does not require any driver support.
|
|
* It is also unprivileged and does not change anything,
|
|
* so we can take a shortcut to it. */
|
|
if (ethcmd == ETHTOOL_GDRVINFO)
|
|
return ethtool_get_drvinfo(dev, useraddr);
|
|
else
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
/* Allow some commands to be done by anyone */
|
|
switch (ethcmd) {
|
|
case ETHTOOL_GSET:
|
|
case ETHTOOL_GDRVINFO:
|
|
case ETHTOOL_GMSGLVL:
|
|
case ETHTOOL_GCOALESCE:
|
|
case ETHTOOL_GRINGPARAM:
|
|
case ETHTOOL_GPAUSEPARAM:
|
|
case ETHTOOL_GRXCSUM:
|
|
case ETHTOOL_GTXCSUM:
|
|
case ETHTOOL_GSG:
|
|
case ETHTOOL_GSTRINGS:
|
|
case ETHTOOL_GTSO:
|
|
case ETHTOOL_GPERMADDR:
|
|
case ETHTOOL_GUFO:
|
|
case ETHTOOL_GGSO:
|
|
case ETHTOOL_GGRO:
|
|
case ETHTOOL_GFLAGS:
|
|
case ETHTOOL_GPFLAGS:
|
|
case ETHTOOL_GRXFH:
|
|
case ETHTOOL_GRXRINGS:
|
|
case ETHTOOL_GRXCLSRLCNT:
|
|
case ETHTOOL_GRXCLSRULE:
|
|
case ETHTOOL_GRXCLSRLALL:
|
|
case ETHTOOL_GFEATURES:
|
|
break;
|
|
default:
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
}
|
|
|
|
if (dev->ethtool_ops->begin) {
|
|
rc = dev->ethtool_ops->begin(dev);
|
|
if (rc < 0)
|
|
return rc;
|
|
}
|
|
old_features = dev->features;
|
|
|
|
switch (ethcmd) {
|
|
case ETHTOOL_GSET:
|
|
rc = ethtool_get_settings(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SSET:
|
|
rc = ethtool_set_settings(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GDRVINFO:
|
|
rc = ethtool_get_drvinfo(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GREGS:
|
|
rc = ethtool_get_regs(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GWOL:
|
|
rc = ethtool_get_wol(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SWOL:
|
|
rc = ethtool_set_wol(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GMSGLVL:
|
|
rc = ethtool_get_value(dev, useraddr, ethcmd,
|
|
dev->ethtool_ops->get_msglevel);
|
|
break;
|
|
case ETHTOOL_SMSGLVL:
|
|
rc = ethtool_set_value_void(dev, useraddr,
|
|
dev->ethtool_ops->set_msglevel);
|
|
break;
|
|
case ETHTOOL_NWAY_RST:
|
|
rc = ethtool_nway_reset(dev);
|
|
break;
|
|
case ETHTOOL_GLINK:
|
|
rc = ethtool_get_link(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GEEPROM:
|
|
rc = ethtool_get_eeprom(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SEEPROM:
|
|
rc = ethtool_set_eeprom(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GCOALESCE:
|
|
rc = ethtool_get_coalesce(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SCOALESCE:
|
|
rc = ethtool_set_coalesce(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GRINGPARAM:
|
|
rc = ethtool_get_ringparam(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SRINGPARAM:
|
|
rc = ethtool_set_ringparam(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GPAUSEPARAM:
|
|
rc = ethtool_get_pauseparam(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SPAUSEPARAM:
|
|
rc = ethtool_set_pauseparam(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_TEST:
|
|
rc = ethtool_self_test(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GSTRINGS:
|
|
rc = ethtool_get_strings(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_PHYS_ID:
|
|
rc = ethtool_phys_id(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GSTATS:
|
|
rc = ethtool_get_stats(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GPERMADDR:
|
|
rc = ethtool_get_perm_addr(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GFLAGS:
|
|
rc = ethtool_get_value(dev, useraddr, ethcmd,
|
|
(dev->ethtool_ops->get_flags ?
|
|
dev->ethtool_ops->get_flags :
|
|
ethtool_op_get_flags));
|
|
break;
|
|
case ETHTOOL_SFLAGS:
|
|
rc = ethtool_set_value(dev, useraddr, __ethtool_set_flags);
|
|
break;
|
|
case ETHTOOL_GPFLAGS:
|
|
rc = ethtool_get_value(dev, useraddr, ethcmd,
|
|
dev->ethtool_ops->get_priv_flags);
|
|
break;
|
|
case ETHTOOL_SPFLAGS:
|
|
rc = ethtool_set_value(dev, useraddr,
|
|
dev->ethtool_ops->set_priv_flags);
|
|
break;
|
|
case ETHTOOL_GRXFH:
|
|
case ETHTOOL_GRXRINGS:
|
|
case ETHTOOL_GRXCLSRLCNT:
|
|
case ETHTOOL_GRXCLSRULE:
|
|
case ETHTOOL_GRXCLSRLALL:
|
|
rc = ethtool_get_rxnfc(dev, ethcmd, useraddr);
|
|
break;
|
|
case ETHTOOL_SRXFH:
|
|
case ETHTOOL_SRXCLSRLDEL:
|
|
case ETHTOOL_SRXCLSRLINS:
|
|
rc = ethtool_set_rxnfc(dev, ethcmd, useraddr);
|
|
break;
|
|
case ETHTOOL_FLASHDEV:
|
|
rc = ethtool_flash_device(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_RESET:
|
|
rc = ethtool_reset(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SRXNTUPLE:
|
|
rc = ethtool_set_rx_ntuple(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GRXNTUPLE:
|
|
rc = ethtool_get_rx_ntuple(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GSSET_INFO:
|
|
rc = ethtool_get_sset_info(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GRXFHINDIR:
|
|
rc = ethtool_get_rxfh_indir(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SRXFHINDIR:
|
|
rc = ethtool_set_rxfh_indir(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GFEATURES:
|
|
rc = ethtool_get_features(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SFEATURES:
|
|
rc = ethtool_set_features(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_GTXCSUM:
|
|
case ETHTOOL_GRXCSUM:
|
|
case ETHTOOL_GSG:
|
|
case ETHTOOL_GTSO:
|
|
case ETHTOOL_GUFO:
|
|
case ETHTOOL_GGSO:
|
|
case ETHTOOL_GGRO:
|
|
rc = ethtool_get_one_feature(dev, useraddr, ethcmd);
|
|
break;
|
|
case ETHTOOL_STXCSUM:
|
|
case ETHTOOL_SRXCSUM:
|
|
case ETHTOOL_SSG:
|
|
case ETHTOOL_STSO:
|
|
case ETHTOOL_SUFO:
|
|
case ETHTOOL_SGSO:
|
|
case ETHTOOL_SGRO:
|
|
rc = ethtool_set_one_feature(dev, useraddr, ethcmd);
|
|
break;
|
|
case ETHTOOL_GCHANNELS:
|
|
rc = ethtool_get_channels(dev, useraddr);
|
|
break;
|
|
case ETHTOOL_SCHANNELS:
|
|
rc = ethtool_set_channels(dev, useraddr);
|
|
break;
|
|
default:
|
|
rc = -EOPNOTSUPP;
|
|
}
|
|
|
|
if (dev->ethtool_ops->complete)
|
|
dev->ethtool_ops->complete(dev);
|
|
|
|
if (old_features != dev->features)
|
|
netdev_features_change(dev);
|
|
|
|
return rc;
|
|
}
|