marvell/mwifiex/ethtool.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * NXP Wireless LAN device driver: ethtool
0004  *
0005  * Copyright 2011-2020 NXP
0006  */
0007
0008 #include "main.h"
0009
0010 static void mwifiex_ethtool_get_wol(struct net_device *dev,
0011                     struct ethtool_wolinfo *wol)
0012 {
0013     struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
0014     u32 conditions = le32_to_cpu(priv->adapter->hs_cfg.conditions);
0015
0016     wol->supported = WAKE_UCAST|WAKE_MCAST|WAKE_BCAST|WAKE_PHY;
0017
0018     if (conditions == HS_CFG_COND_DEF)
0019         return;
0020
0021     if (conditions & HS_CFG_COND_UNICAST_DATA)
0022         wol->wolopts |= WAKE_UCAST;
0023     if (conditions & HS_CFG_COND_MULTICAST_DATA)
0024         wol->wolopts |= WAKE_MCAST;
0025     if (conditions & HS_CFG_COND_BROADCAST_DATA)
0026         wol->wolopts |= WAKE_BCAST;
0027     if (conditions & HS_CFG_COND_MAC_EVENT)
0028         wol->wolopts |= WAKE_PHY;
0029 }
0030
0031 static int mwifiex_ethtool_set_wol(struct net_device *dev,
0032                    struct ethtool_wolinfo *wol)
0033 {
0034     struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
0035     u32 conditions = 0;
0036
0037     if (wol->wolopts & ~(WAKE_UCAST|WAKE_MCAST|WAKE_BCAST|WAKE_PHY))
0038         return -EOPNOTSUPP;
0039
0040     if (wol->wolopts & WAKE_UCAST)
0041         conditions |= HS_CFG_COND_UNICAST_DATA;
0042     if (wol->wolopts & WAKE_MCAST)
0043         conditions |= HS_CFG_COND_MULTICAST_DATA;
0044     if (wol->wolopts & WAKE_BCAST)
0045         conditions |= HS_CFG_COND_BROADCAST_DATA;
0046     if (wol->wolopts & WAKE_PHY)
0047         conditions |= HS_CFG_COND_MAC_EVENT;
0048     if (wol->wolopts == 0)
0049         conditions |= HS_CFG_COND_DEF;
0050     priv->adapter->hs_cfg.conditions = cpu_to_le32(conditions);
0051
0052     return 0;
0053 }
0054
0055 const struct ethtool_ops mwifiex_ethtool_ops = {
0056     .get_wol = mwifiex_ethtool_get_wol,
0057     .set_wol = mwifiex_ethtool_set_wol,
0058 };