Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ca0413b6 authored by Ron Mercer's avatar Ron Mercer Committed by David S. Miller
Browse files

qlge: Add support for firmware mailbox commands. 



This interface will be used for setting things like maximum
frame size, setting WOL, and ACKing changes requested by the FCOE
function.

Signed-off-by: default avatarRon Mercer <ron.mercer@qlogic.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent ee7537b6

drivers/net/qlge/qlge_mpi.c

+218 −4
Original line number Diff line number Diff line 
#include "qlge.h"



static void ql_display_mb_sts(struct ql_adapter *qdev,

						struct mbox_params *mbcp)

{

	int i;

	static char *err_sts[] = {

		"Command Complete",

		"Command Not Supported",

		"Host Interface Error",

		"Checksum Error",

		"Unused Completion Status",

		"Test Failed",

		"Command Parameter Error"};



	QPRINTK(qdev, DRV, DEBUG, "%s.\n",

		err_sts[mbcp->mbox_out[0] & 0x0000000f]);

	for (i = 0; i < mbcp->out_count; i++)

		QPRINTK(qdev, DRV, DEBUG, "mbox_out[%d] = 0x%.08x.\n",

				i, mbcp->mbox_out[i]);

}



int ql_read_mpi_reg(struct ql_adapter *qdev, u32 reg, u32 *data)

{

	int status;
@@ -65,6 +85,59 @@ static int ql_get_mb_sts(struct ql_adapter *qdev, struct mbox_params *mbcp) 
	return status;

}



/* Wait for a single mailbox command to complete.

 * Returns zero on success.

 */

static int ql_wait_mbx_cmd_cmplt(struct ql_adapter *qdev)

{

	int count = 50;	/* TODO: arbitrary for now. */

	u32 value;



	do {

		value = ql_read32(qdev, STS);

		if (value & STS_PI)

			return 0;

		udelay(UDELAY_DELAY); /* 10us */

	} while (--count);

	return -ETIMEDOUT;

}



/* Execute a single mailbox command.

 * Caller must hold PROC_ADDR semaphore.

 */

static int ql_exec_mb_cmd(struct ql_adapter *qdev, struct mbox_params *mbcp)

{

	int i, status;



	/*

	 * Make sure there's nothing pending.

	 * This shouldn't happen.

	 */

	if (ql_read32(qdev, CSR) & CSR_HRI)

		return -EIO;



	status = ql_sem_spinlock(qdev, SEM_PROC_REG_MASK);

	if (status)

		return status;



	/*

	 * Fill the outbound mailboxes.

	 */

	for (i = 0; i < mbcp->in_count; i++) {

		status = ql_write_mpi_reg(qdev, qdev->mailbox_in + i,

						mbcp->mbox_in[i]);

		if (status)

			goto end;

	}

	/*

	 * Wake up the MPI firmware.

	 */

	ql_write32(qdev, CSR, CSR_CMD_SET_H2R_INT);

end:

	ql_sem_unlock(qdev, SEM_PROC_REG_MASK);

	return status;

}



static void ql_link_up(struct ql_adapter *qdev, struct mbox_params *mbcp)

{

	mbcp->out_count = 2;
@@ -133,6 +206,7 @@ exit: 
static int ql_mpi_handler(struct ql_adapter *qdev, struct mbox_params *mbcp)

{

	int status;

	int orig_count = mbcp->out_count;



	/* Just get mailbox zero for now. */

	mbcp->out_count = 1;
@@ -146,6 +220,27 @@ static int ql_mpi_handler(struct ql_adapter *qdev, struct mbox_params *mbcp) 


	switch (mbcp->mbox_out[0]) {



	/* This case is only active when we arrive here

	 * as a result of issuing a mailbox command to

	 * the firmware.

	 */

	case MB_CMD_STS_INTRMDT:

	case MB_CMD_STS_GOOD:

	case MB_CMD_STS_INVLD_CMD:

	case MB_CMD_STS_XFC_ERR:

	case MB_CMD_STS_CSUM_ERR:

	case MB_CMD_STS_ERR:

	case MB_CMD_STS_PARAM_ERR:

		/* We can only get mailbox status if we're polling from an

		 * unfinished command.  Get the rest of the status data and

		 * return back to the caller.

		 * We only end up here when we're polling for a mailbox

		 * command completion.

		 */

		mbcp->out_count = orig_count;

		status = ql_get_mb_sts(qdev, mbcp);

		return status;



	case AEN_LINK_UP:

		ql_link_up(qdev, mbcp);

		break;
@@ -158,12 +253,8 @@ static int ql_mpi_handler(struct ql_adapter *qdev, struct mbox_params *mbcp) 
		ql_init_fw_done(qdev, mbcp);

		break;



	case MB_CMD_STS_GOOD:

		break;



	case AEN_FW_INIT_FAIL:

	case AEN_SYS_ERR:

	case MB_CMD_STS_ERR:

		ql_queue_fw_error(qdev);

		break;
@@ -177,6 +268,129 @@ end: 
	return status;

}



/* Execute a single mailbox command.

 * mbcp is a pointer to an array of u32.  Each

 * element in the array contains the value for it's

 * respective mailbox register.

 */

static int ql_mailbox_command(struct ql_adapter *qdev, struct mbox_params *mbcp)

{

	int status, count;



	mutex_lock(&qdev->mpi_mutex);



	/* Begin polled mode for MPI */

	ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16));



	/* Load the mailbox registers and wake up MPI RISC. */

	status = ql_exec_mb_cmd(qdev, mbcp);

	if (status)

		goto end;





	/* If we're generating a system error, then there's nothing

	 * to wait for.

	 */

	if (mbcp->mbox_in[0] == MB_CMD_MAKE_SYS_ERR)

		goto end;



	/* Wait for the command to complete. We loop

	 * here because some AEN might arrive while

	 * we're waiting for the mailbox command to

	 * complete. If more than 5 arrive then we can

	 * assume something is wrong. */

	count = 5;

	do {

		/* Wait for the interrupt to come in. */

		status = ql_wait_mbx_cmd_cmplt(qdev);

		if (status)

			goto end;



		/* Process the event.  If it's an AEN, it

		 * will be handled in-line or a worker

		 * will be spawned. If it's our completion

		 * we will catch it below.

		 */

		status = ql_mpi_handler(qdev, mbcp);

		if (status)

			goto end;



		/* It's either the completion for our mailbox

		 * command complete or an AEN.  If it's our

		 * completion then get out.

		 */

		if (((mbcp->mbox_out[0] & 0x0000f000) ==

					MB_CMD_STS_GOOD) ||

			((mbcp->mbox_out[0] & 0x0000f000) ==

					MB_CMD_STS_INTRMDT))

			break;

	} while (--count);



	if (!count) {

		QPRINTK(qdev, DRV, ERR,

			"Timed out waiting for mailbox complete.\n");

		status = -ETIMEDOUT;

		goto end;

	}



	/* Now we can clear the interrupt condition

	 * and look at our status.

	 */

	ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);



	if (((mbcp->mbox_out[0] & 0x0000f000) !=

					MB_CMD_STS_GOOD) &&

		((mbcp->mbox_out[0] & 0x0000f000) !=

					MB_CMD_STS_INTRMDT)) {

		ql_display_mb_sts(qdev, mbcp);

		status = -EIO;

	}

end:

	mutex_unlock(&qdev->mpi_mutex);

	/* End polled mode for MPI */

	ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16) | INTR_MASK_PI);

	return status;

}



/* Get functional state for MPI firmware.

 * Returns zero on success.

 */

int ql_mb_get_fw_state(struct ql_adapter *qdev)

{

	struct mbox_params mbc;

	struct mbox_params *mbcp = &mbc;

	int status = 0;



	memset(mbcp, 0, sizeof(struct mbox_params));



	mbcp->in_count = 1;

	mbcp->out_count = 2;



	mbcp->mbox_in[0] = MB_CMD_GET_FW_STATE;



	status = ql_mailbox_command(qdev, mbcp);

	if (status)

		return status;



	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {

		QPRINTK(qdev, DRV, ERR,

			"Failed Get Firmware State.\n");

		status = -EIO;

	}



	/* If bit zero is set in mbx 1 then the firmware is

	 * running, but not initialized.  This should never

	 * happen.

	 */

	if (mbcp->mbox_out[1] & 1) {

		QPRINTK(qdev, DRV, ERR,

			"Firmware waiting for initialization.\n");

		status = -EIO;

	}



	return status;

}



void ql_mpi_work(struct work_struct *work)

{

	struct ql_adapter *qdev =