forked from Minki/linux
125844eaff
This is not a logical change but rather a move of the inbound firmware event handler into it's own function as it will later be called by the outbound path. The addition of the mutex is to create exclusive access to the mailbox commands between inbound and outbound handling. Signed-off-by: Ron Mercer <ron.mercer@qlogic.com> Signed-off-by: David S. Miller <davem@davemloft.net>
205 lines
4.9 KiB
C
205 lines
4.9 KiB
C
#include "qlge.h"
|
|
|
|
int ql_read_mpi_reg(struct ql_adapter *qdev, u32 reg, u32 *data)
|
|
{
|
|
int status;
|
|
/* wait for reg to come ready */
|
|
status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
|
|
if (status)
|
|
goto exit;
|
|
/* set up for reg read */
|
|
ql_write32(qdev, PROC_ADDR, reg | PROC_ADDR_R);
|
|
/* wait for reg to come ready */
|
|
status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
|
|
if (status)
|
|
goto exit;
|
|
/* get the data */
|
|
*data = ql_read32(qdev, PROC_DATA);
|
|
exit:
|
|
return status;
|
|
}
|
|
|
|
int ql_write_mpi_reg(struct ql_adapter *qdev, u32 reg, u32 data)
|
|
{
|
|
int status = 0;
|
|
/* wait for reg to come ready */
|
|
status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
|
|
if (status)
|
|
goto exit;
|
|
/* write the data to the data reg */
|
|
ql_write32(qdev, PROC_DATA, data);
|
|
/* trigger the write */
|
|
ql_write32(qdev, PROC_ADDR, reg);
|
|
/* wait for reg to come ready */
|
|
status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
|
|
if (status)
|
|
goto exit;
|
|
exit:
|
|
return status;
|
|
}
|
|
|
|
int ql_soft_reset_mpi_risc(struct ql_adapter *qdev)
|
|
{
|
|
int status;
|
|
status = ql_write_mpi_reg(qdev, 0x00001010, 1);
|
|
return status;
|
|
}
|
|
|
|
static int ql_get_mb_sts(struct ql_adapter *qdev, struct mbox_params *mbcp)
|
|
{
|
|
int i, status;
|
|
|
|
status = ql_sem_spinlock(qdev, SEM_PROC_REG_MASK);
|
|
if (status)
|
|
return -EBUSY;
|
|
for (i = 0; i < mbcp->out_count; i++) {
|
|
status =
|
|
ql_read_mpi_reg(qdev, qdev->mailbox_out + i,
|
|
&mbcp->mbox_out[i]);
|
|
if (status) {
|
|
QPRINTK(qdev, DRV, ERR, "Failed mailbox read.\n");
|
|
break;
|
|
}
|
|
}
|
|
ql_sem_unlock(qdev, SEM_PROC_REG_MASK); /* does flush too */
|
|
return status;
|
|
}
|
|
|
|
static void ql_link_up(struct ql_adapter *qdev, struct mbox_params *mbcp)
|
|
{
|
|
mbcp->out_count = 2;
|
|
|
|
if (ql_get_mb_sts(qdev, mbcp))
|
|
goto exit;
|
|
|
|
qdev->link_status = mbcp->mbox_out[1];
|
|
QPRINTK(qdev, DRV, ERR, "Link Up.\n");
|
|
QPRINTK(qdev, DRV, INFO, "Link Status = 0x%.08x.\n", mbcp->mbox_out[1]);
|
|
if (!netif_carrier_ok(qdev->ndev)) {
|
|
QPRINTK(qdev, LINK, INFO, "Link is Up.\n");
|
|
netif_carrier_on(qdev->ndev);
|
|
netif_wake_queue(qdev->ndev);
|
|
}
|
|
exit:
|
|
/* Clear the MPI firmware status. */
|
|
ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);
|
|
}
|
|
|
|
static void ql_link_down(struct ql_adapter *qdev, struct mbox_params *mbcp)
|
|
{
|
|
mbcp->out_count = 3;
|
|
|
|
if (ql_get_mb_sts(qdev, mbcp)) {
|
|
QPRINTK(qdev, DRV, ERR, "Firmware did not initialize!\n");
|
|
goto exit;
|
|
}
|
|
|
|
if (netif_carrier_ok(qdev->ndev)) {
|
|
QPRINTK(qdev, LINK, INFO, "Link is Down.\n");
|
|
netif_carrier_off(qdev->ndev);
|
|
netif_stop_queue(qdev->ndev);
|
|
}
|
|
QPRINTK(qdev, DRV, ERR, "Link Down.\n");
|
|
QPRINTK(qdev, DRV, ERR, "Link Status = 0x%.08x.\n", mbcp->mbox_out[1]);
|
|
exit:
|
|
/* Clear the MPI firmware status. */
|
|
ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);
|
|
}
|
|
|
|
static void ql_init_fw_done(struct ql_adapter *qdev, struct mbox_params *mbcp)
|
|
{
|
|
mbcp->out_count = 2;
|
|
|
|
if (ql_get_mb_sts(qdev, mbcp)) {
|
|
QPRINTK(qdev, DRV, ERR, "Firmware did not initialize!\n");
|
|
goto exit;
|
|
}
|
|
QPRINTK(qdev, DRV, ERR, "Firmware initialized!\n");
|
|
QPRINTK(qdev, DRV, ERR, "Firmware status = 0x%.08x.\n",
|
|
mbcp->mbox_out[0]);
|
|
QPRINTK(qdev, DRV, ERR, "Firmware Revision = 0x%.08x.\n",
|
|
mbcp->mbox_out[1]);
|
|
exit:
|
|
/* Clear the MPI firmware status. */
|
|
ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);
|
|
}
|
|
|
|
/* Process an async event and clear it unless it's an
|
|
* error condition.
|
|
* This can get called iteratively from the mpi_work thread
|
|
* when events arrive via an interrupt.
|
|
* It also gets called when a mailbox command is polling for
|
|
* it's completion. */
|
|
static int ql_mpi_handler(struct ql_adapter *qdev, struct mbox_params *mbcp)
|
|
{
|
|
int status;
|
|
|
|
/* Just get mailbox zero for now. */
|
|
mbcp->out_count = 1;
|
|
status = ql_get_mb_sts(qdev, mbcp);
|
|
if (status) {
|
|
QPRINTK(qdev, DRV, ERR,
|
|
"Could not read MPI, resetting ASIC!\n");
|
|
ql_queue_asic_error(qdev);
|
|
goto end;
|
|
}
|
|
|
|
switch (mbcp->mbox_out[0]) {
|
|
|
|
case AEN_LINK_UP:
|
|
ql_link_up(qdev, mbcp);
|
|
break;
|
|
|
|
case AEN_LINK_DOWN:
|
|
ql_link_down(qdev, mbcp);
|
|
break;
|
|
|
|
case AEN_FW_INIT_DONE:
|
|
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;
|
|
|
|
default:
|
|
QPRINTK(qdev, DRV, ERR,
|
|
"Unsupported AE %.08x.\n", mbcp->mbox_out[0]);
|
|
/* Clear the MPI firmware status. */
|
|
}
|
|
end:
|
|
ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);
|
|
return status;
|
|
}
|
|
|
|
void ql_mpi_work(struct work_struct *work)
|
|
{
|
|
struct ql_adapter *qdev =
|
|
container_of(work, struct ql_adapter, mpi_work.work);
|
|
struct mbox_params mbc;
|
|
struct mbox_params *mbcp = &mbc;
|
|
|
|
mutex_lock(&qdev->mpi_mutex);
|
|
|
|
while (ql_read32(qdev, STS) & STS_PI) {
|
|
memset(mbcp, 0, sizeof(struct mbox_params));
|
|
mbcp->out_count = 1;
|
|
ql_mpi_handler(qdev, mbcp);
|
|
}
|
|
|
|
mutex_unlock(&qdev->mpi_mutex);
|
|
ql_enable_completion_interrupt(qdev, 0);
|
|
}
|
|
|
|
void ql_mpi_reset_work(struct work_struct *work)
|
|
{
|
|
struct ql_adapter *qdev =
|
|
container_of(work, struct ql_adapter, mpi_reset_work.work);
|
|
ql_soft_reset_mpi_risc(qdev);
|
|
}
|