qlge: Add ethtool wake on LAN function.

Signed-off-by: Ron Mercer <ron.mercer@qlogic.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

1 files changed, 70 insertions, 0 deletions

diff --git a/drivers/net/qlge/qlge_mpi.c b/drivers/net/qlge/qlge_mpi.c
index 14d76f13d1db..80b68539c5aa 100644
--- a/drivers/net/qlge/qlge_mpi.c
+++ b/drivers/net/qlge/qlge_mpi.c
@@ -702,6 +702,76 @@ int ql_mb_get_port_cfg(struct ql_adapter *qdev)
         return status;
 }
 
+int ql_mb_wol_mode(struct ql_adapter *qdev, u32 wol)
+{
+        struct mbox_params mbc;
+        struct mbox_params *mbcp = &mbc;
+        int status;
+
+        memset(mbcp, 0, sizeof(struct mbox_params));
+
+        mbcp->in_count = 2;
+        mbcp->out_count = 1;
+
+        mbcp->mbox_in[0] = MB_CMD_SET_WOL_MODE;
+        mbcp->mbox_in[1] = wol;
+
+
+        status = ql_mailbox_command(qdev, mbcp);
+        if (status)
+                return status;
+
+        if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
+                QPRINTK(qdev, DRV, ERR,
+                        "Failed to set WOL mode.\n");
+                status = -EIO;
+        }
+        return status;
+}
+
+int ql_mb_wol_set_magic(struct ql_adapter *qdev, u32 enable_wol)
+{
+        struct mbox_params mbc;
+        struct mbox_params *mbcp = &mbc;
+        int status;
+        u8 *addr = qdev->ndev->dev_addr;
+
+        memset(mbcp, 0, sizeof(struct mbox_params));
+
+        mbcp->in_count = 8;
+        mbcp->out_count = 1;
+
+        mbcp->mbox_in[0] = MB_CMD_SET_WOL_MAGIC;
+        if (enable_wol) {
+                mbcp->mbox_in[1] = (u32)addr[0];
+                mbcp->mbox_in[2] = (u32)addr[1];
+                mbcp->mbox_in[3] = (u32)addr[2];
+                mbcp->mbox_in[4] = (u32)addr[3];
+                mbcp->mbox_in[5] = (u32)addr[4];
+                mbcp->mbox_in[6] = (u32)addr[5];
+                mbcp->mbox_in[7] = 0;
+        } else {
+                mbcp->mbox_in[1] = 0;
+                mbcp->mbox_in[2] = 1;
+                mbcp->mbox_in[3] = 1;
+                mbcp->mbox_in[4] = 1;
+                mbcp->mbox_in[5] = 1;
+                mbcp->mbox_in[6] = 1;
+                mbcp->mbox_in[7] = 0;
+        }
+
+        status = ql_mailbox_command(qdev, mbcp);
+        if (status)
+                return status;
+
+        if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
+                QPRINTK(qdev, DRV, ERR,
+                        "Failed to set WOL mode.\n");
+                status = -EIO;
+        }
+        return status;
+}
+
 /* IDC - Inter Device Communication...
  * Some firmware commands require consent of adjacent FCOE
  * function.  This function waits for the OK, or a