Commit 96e65d7f authored by Florian Fainelli's avatar Florian Fainelli Committed by David S. Miller
Browse files

net: dsa: bcm_sf2: add support for Wake-on-LAN 



In order for Wake-on-LAN to work properly, we query the parent network
device Wake-on-LAN features and advertise those. Similarly, when
configuring Wake-on-LAN on a per-port network interface, we make sure
that we do not accept something the master network devices does not
support.

Finally, we need to maintain a bitmask of the ports enabled for
Wake-on-LAN to prevent the suspend() callback from disabling a port that
is used for waking up the system.

Signed-off-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 19e57c4e

drivers/net/dsa/bcm_sf2.c

+58 −0
Original line number Diff line number Diff line
@@ -22,6 +22,7 @@ 
#include <linux/of_irq.h>

#include <linux/of_address.h>

#include <net/dsa.h>

#include <linux/ethtool.h>



#include "bcm_sf2.h"

#include "bcm_sf2_regs.h"
@@ -242,6 +243,9 @@ static void bcm_sf2_port_disable(struct dsa_switch *ds, int port) 
	struct bcm_sf2_priv *priv = ds_to_priv(ds);

	u32 off, reg;



	if (priv->wol_ports_mask & (1 << port))

		return;



	if (dsa_is_cpu_port(ds, port))

		off = CORE_IMP_CTL;

	else
@@ -689,6 +693,58 @@ static int bcm_sf2_sw_resume(struct dsa_switch *ds) 
	return 0;

}



static void bcm_sf2_sw_get_wol(struct dsa_switch *ds, int port,

			       struct ethtool_wolinfo *wol)

{

	struct net_device *p = ds->dst[ds->index].master_netdev;

	struct bcm_sf2_priv *priv = ds_to_priv(ds);

	struct ethtool_wolinfo pwol;



	/* Get the parent device WoL settings */

	p->ethtool_ops->get_wol(p, &pwol);



	/* Advertise the parent device supported settings */

	wol->supported = pwol.supported;

	memset(&wol->sopass, 0, sizeof(wol->sopass));



	if (pwol.wolopts & WAKE_MAGICSECURE)

		memcpy(&wol->sopass, pwol.sopass, sizeof(wol->sopass));



	if (priv->wol_ports_mask & (1 << port))

		wol->wolopts = pwol.wolopts;

	else

		wol->wolopts = 0;

}



static int bcm_sf2_sw_set_wol(struct dsa_switch *ds, int port,

			      struct ethtool_wolinfo *wol)

{

	struct net_device *p = ds->dst[ds->index].master_netdev;

	struct bcm_sf2_priv *priv = ds_to_priv(ds);

	s8 cpu_port = ds->dst[ds->index].cpu_port;

	struct ethtool_wolinfo pwol;



	p->ethtool_ops->get_wol(p, &pwol);

	if (wol->wolopts & ~pwol.supported)

		return -EINVAL;



	if (wol->wolopts)

		priv->wol_ports_mask |= (1 << port);

	else

		priv->wol_ports_mask &= ~(1 << port);



	/* If we have at least one port enabled, make sure the CPU port

	 * is also enabled. If the CPU port is the last one enabled, we disable

	 * it since this configuration does not make sense.

	 */

	if (priv->wol_ports_mask && priv->wol_ports_mask != (1 << cpu_port))

		priv->wol_ports_mask |= (1 << cpu_port);

	else

		priv->wol_ports_mask &= ~(1 << cpu_port);



	return p->ethtool_ops->set_wol(p, wol);

}



static struct dsa_switch_driver bcm_sf2_switch_driver = {

	.tag_protocol		= DSA_TAG_PROTO_BRCM,

	.priv_size		= sizeof(struct bcm_sf2_priv),
@@ -705,6 +761,8 @@ static struct dsa_switch_driver bcm_sf2_switch_driver = { 
	.fixed_link_update	= bcm_sf2_sw_fixed_link_update,

	.suspend		= bcm_sf2_sw_suspend,

	.resume			= bcm_sf2_sw_resume,

	.get_wol		= bcm_sf2_sw_get_wol,

	.set_wol		= bcm_sf2_sw_set_wol,

};



static int __init bcm_sf2_init(void)

drivers/net/dsa/bcm_sf2.h

+3 −0
Original line number Diff line number Diff line
@@ -70,6 +70,9 @@ struct bcm_sf2_priv { 
	struct bcm_sf2_hw_params	hw_params;



	struct bcm_sf2_port_status	port_sts[DSA_MAX_PORTS];



	/* Mask of ports enabled for Wake-on-LAN */

	u32				wol_ports_mask;

};



struct bcm_sf2_hw_stats {

CRA Git | Maintained and supported by SUSTech CRA and CCSE