66fceb69b7
In suspend() host sleep is activated using already configured host sleep parameters through wol command, and in resume() host sleep is cancelled. Earlier priv->fw_ready flag used to reset and set in suspend and resume handler respectively. Since after suspend only host goes into sleep state and firmware is always ready, those changes in flag state are removed. Signed-off-by: Amitkumar Karwar <akarwar@marvell.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
124 lines
3.3 KiB
C
124 lines
3.3 KiB
C
#include <linux/netdevice.h>
|
|
#include <linux/ethtool.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include "host.h"
|
|
#include "decl.h"
|
|
#include "defs.h"
|
|
#include "dev.h"
|
|
#include "wext.h"
|
|
#include "cmd.h"
|
|
#include "mesh.h"
|
|
|
|
|
|
static void lbs_ethtool_get_drvinfo(struct net_device *dev,
|
|
struct ethtool_drvinfo *info)
|
|
{
|
|
struct lbs_private *priv = dev->ml_priv;
|
|
|
|
snprintf(info->fw_version, 32, "%u.%u.%u.p%u",
|
|
priv->fwrelease >> 24 & 0xff,
|
|
priv->fwrelease >> 16 & 0xff,
|
|
priv->fwrelease >> 8 & 0xff,
|
|
priv->fwrelease & 0xff);
|
|
strcpy(info->driver, "libertas");
|
|
strcpy(info->version, lbs_driver_version);
|
|
}
|
|
|
|
/* All 8388 parts have 16KiB EEPROM size at the time of writing.
|
|
* In case that changes this needs fixing.
|
|
*/
|
|
#define LBS_EEPROM_LEN 16384
|
|
|
|
static int lbs_ethtool_get_eeprom_len(struct net_device *dev)
|
|
{
|
|
return LBS_EEPROM_LEN;
|
|
}
|
|
|
|
static int lbs_ethtool_get_eeprom(struct net_device *dev,
|
|
struct ethtool_eeprom *eeprom, u8 * bytes)
|
|
{
|
|
struct lbs_private *priv = dev->ml_priv;
|
|
struct cmd_ds_802_11_eeprom_access cmd;
|
|
int ret;
|
|
|
|
lbs_deb_enter(LBS_DEB_ETHTOOL);
|
|
|
|
if (eeprom->offset + eeprom->len > LBS_EEPROM_LEN ||
|
|
eeprom->len > LBS_EEPROM_READ_LEN) {
|
|
ret = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
cmd.hdr.size = cpu_to_le16(sizeof(struct cmd_ds_802_11_eeprom_access) -
|
|
LBS_EEPROM_READ_LEN + eeprom->len);
|
|
cmd.action = cpu_to_le16(CMD_ACT_GET);
|
|
cmd.offset = cpu_to_le16(eeprom->offset);
|
|
cmd.len = cpu_to_le16(eeprom->len);
|
|
ret = lbs_cmd_with_response(priv, CMD_802_11_EEPROM_ACCESS, &cmd);
|
|
if (!ret)
|
|
memcpy(bytes, cmd.value, eeprom->len);
|
|
|
|
out:
|
|
lbs_deb_leave_args(LBS_DEB_ETHTOOL, "ret %d", ret);
|
|
return ret;
|
|
}
|
|
|
|
static void lbs_ethtool_get_wol(struct net_device *dev,
|
|
struct ethtool_wolinfo *wol)
|
|
{
|
|
struct lbs_private *priv = dev->ml_priv;
|
|
|
|
if (priv->wol_criteria == 0xffffffff) {
|
|
/* Interface driver didn't configure wake */
|
|
wol->supported = wol->wolopts = 0;
|
|
return;
|
|
}
|
|
|
|
wol->supported = WAKE_UCAST|WAKE_MCAST|WAKE_BCAST|WAKE_PHY;
|
|
|
|
if (priv->wol_criteria & EHS_WAKE_ON_UNICAST_DATA)
|
|
wol->wolopts |= WAKE_UCAST;
|
|
if (priv->wol_criteria & EHS_WAKE_ON_MULTICAST_DATA)
|
|
wol->wolopts |= WAKE_MCAST;
|
|
if (priv->wol_criteria & EHS_WAKE_ON_BROADCAST_DATA)
|
|
wol->wolopts |= WAKE_BCAST;
|
|
if (priv->wol_criteria & EHS_WAKE_ON_MAC_EVENT)
|
|
wol->wolopts |= WAKE_PHY;
|
|
}
|
|
|
|
static int lbs_ethtool_set_wol(struct net_device *dev,
|
|
struct ethtool_wolinfo *wol)
|
|
{
|
|
struct lbs_private *priv = dev->ml_priv;
|
|
|
|
if (wol->wolopts & ~(WAKE_UCAST|WAKE_MCAST|WAKE_BCAST|WAKE_PHY))
|
|
return -EOPNOTSUPP;
|
|
|
|
priv->wol_criteria = 0;
|
|
if (wol->wolopts & WAKE_UCAST)
|
|
priv->wol_criteria |= EHS_WAKE_ON_UNICAST_DATA;
|
|
if (wol->wolopts & WAKE_MCAST)
|
|
priv->wol_criteria |= EHS_WAKE_ON_MULTICAST_DATA;
|
|
if (wol->wolopts & WAKE_BCAST)
|
|
priv->wol_criteria |= EHS_WAKE_ON_BROADCAST_DATA;
|
|
if (wol->wolopts & WAKE_PHY)
|
|
priv->wol_criteria |= EHS_WAKE_ON_MAC_EVENT;
|
|
if (wol->wolopts == 0)
|
|
priv->wol_criteria |= EHS_REMOVE_WAKEUP;
|
|
return 0;
|
|
}
|
|
|
|
const struct ethtool_ops lbs_ethtool_ops = {
|
|
.get_drvinfo = lbs_ethtool_get_drvinfo,
|
|
.get_eeprom = lbs_ethtool_get_eeprom,
|
|
.get_eeprom_len = lbs_ethtool_get_eeprom_len,
|
|
#ifdef CONFIG_LIBERTAS_MESH
|
|
.get_sset_count = lbs_mesh_ethtool_get_sset_count,
|
|
.get_ethtool_stats = lbs_mesh_ethtool_get_stats,
|
|
.get_strings = lbs_mesh_ethtool_get_strings,
|
|
#endif
|
|
.get_wol = lbs_ethtool_get_wol,
|
|
.set_wol = lbs_ethtool_set_wol,
|
|
};
|
|
|