Commit 71d8d1b5 authored by Ajit Khaparde's avatar Ajit Khaparde Committed by David S. Miller
Browse files

be2net: Support for WoL using magic packet after suspend. 



Add support for WOL using Magic Packet after suspend is done.

Signed-off-by: default avatarSarveshwar Bandi <sarveshwarb@serverengines.com>
Signed-off-by: default avatarAjit Khaparde <ajitk@serverengines.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent d744b44e

drivers/net/benet/be.h

+1 −0
Original line number Diff line number Diff line
@@ -269,6 +269,7 @@ struct be_adapter { 
	bool link_up;

	u32 port_num;

	bool promiscuous;

	bool wol;

	u32 cap;

	u32 rx_fc;		/* Rx flow control */

	u32 tx_fc;		/* Tx flow control */

drivers/net/benet/be_cmds.c

+36 −0
Original line number Diff line number Diff line
@@ -1442,3 +1442,39 @@ int be_cmd_get_flash_crc(struct be_adapter *adapter, u8 *flashed_crc) 
	spin_unlock_bh(&adapter->mcc_lock);

	return status;

}



extern int be_cmd_enable_magic_wol(struct be_adapter *adapter, u8 *mac,

				struct be_dma_mem *nonemb_cmd)

{

	struct be_mcc_wrb *wrb;

	struct be_cmd_req_acpi_wol_magic_config *req;

	struct be_sge *sge;

	int status;



	spin_lock_bh(&adapter->mcc_lock);



	wrb = wrb_from_mccq(adapter);

	if (!wrb) {

		status = -EBUSY;

		goto err;

	}

	req = nonemb_cmd->va;

	sge = nonembedded_sgl(wrb);



	be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1,

			OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG);



	be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH,

		OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG, sizeof(*req));

	memcpy(req->magic_mac, mac, ETH_ALEN);



	sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma));

	sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF);

	sge->len = cpu_to_le32(nonemb_cmd->size);



	status = be_mcc_notify_wait(adapter);



err:

	spin_unlock_bh(&adapter->mcc_lock);

	return status;

}

drivers/net/benet/be_cmds.h

+11 −0
Original line number Diff line number Diff line
@@ -150,6 +150,7 @@ struct be_mcc_mailbox { 
#define OPCODE_ETH_RX_CREATE            		8

#define OPCODE_ETH_TX_DESTROY           		9

#define OPCODE_ETH_RX_DESTROY           		10

#define OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG		12



struct be_cmd_req_hdr {

	u8 opcode;		/* dword 0 */
@@ -788,6 +789,14 @@ struct be_cmd_write_flashrom { 
	struct flashrom_params params;

};



/************************ WOL *******************************/

struct be_cmd_req_acpi_wol_magic_config{

	struct be_cmd_req_hdr hdr;

	u32 rsvd0[145];

	u8 magic_mac[6];

	u8 rsvd2[2];

} __packed;



extern int be_pci_fnum_get(struct be_adapter *adapter);

extern int be_cmd_POST(struct be_adapter *adapter);

extern int be_cmd_mac_addr_query(struct be_adapter *adapter, u8 *mac_addr,
@@ -851,5 +860,7 @@ extern int be_cmd_write_flashrom(struct be_adapter *adapter, 
			struct be_dma_mem *cmd, u32 flash_oper,

			u32 flash_opcode, u32 buf_size);

extern int be_cmd_get_flash_crc(struct be_adapter *adapter, u8 *flashed_crc);

extern int be_cmd_enable_magic_wol(struct be_adapter *adapter, u8 *mac,

				struct be_dma_mem *nonemb_cmd);

extern int be_cmd_fw_init(struct be_adapter *adapter);

extern int be_cmd_fw_clean(struct be_adapter *adapter);

drivers/net/benet/be_ethtool.c

+32 −0
Original line number Diff line number Diff line
@@ -411,6 +411,36 @@ be_phys_id(struct net_device *netdev, u32 data) 
	return status;

}



static void

be_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)

{

	struct be_adapter *adapter = netdev_priv(netdev);



	wol->supported = WAKE_MAGIC;

	if (adapter->wol)

		wol->wolopts = WAKE_MAGIC;

	else

		wol->wolopts = 0;

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

	return;

}



static int

be_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)

{

	struct be_adapter *adapter = netdev_priv(netdev);



	if (wol->wolopts & ~WAKE_MAGIC)

		return -EINVAL;



	if (wol->wolopts & WAKE_MAGIC)

		adapter->wol = true;

	else

		adapter->wol = false;



	return 0;

}



static int

be_do_flash(struct net_device *netdev, struct ethtool_flash *efl)

{
@@ -428,6 +458,8 @@ be_do_flash(struct net_device *netdev, struct ethtool_flash *efl) 
const struct ethtool_ops be_ethtool_ops = {

	.get_settings = be_get_settings,

	.get_drvinfo = be_get_drvinfo,

	.get_wol = be_get_wol,

	.set_wol = be_set_wol,

	.get_link = ethtool_op_get_link,

	.get_coalesce = be_get_coalesce,

	.set_coalesce = be_set_coalesce,

drivers/net/benet/be_hw.h

+4 −0
Original line number Diff line number Diff line
@@ -52,6 +52,10 @@ 
 */

#define MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK	(1 << 29) /* bit 29 */



/********* Power managment (WOL) **********/

#define PCICFG_PM_CONTROL_OFFSET		0x44

#define PCICFG_PM_CONTROL_MASK			0x108	/* bits 3 & 8 */



/********* ISR0 Register offset **********/

#define CEV_ISR0_OFFSET 			0xC18

#define CEV_ISR_SIZE				4