mirror of https://gitee.com/openkylin/linux.git
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);
|
|
}
|