|
|
@@ -17,7 +17,7 @@
|
|
|
|
|
|
#include "bfad_drv.h"
|
|
|
#include "bfa_ioc.h"
|
|
|
-#include "bfi_ctreg.h"
|
|
|
+#include "bfi_reg.h"
|
|
|
#include "bfa_defs.h"
|
|
|
#include "bfa_defs_svc.h"
|
|
|
|
|
|
@@ -29,8 +29,8 @@ BFA_TRC_FILE(CNA, IOC);
|
|
|
#define BFA_IOC_TOV 3000 /* msecs */
|
|
|
#define BFA_IOC_HWSEM_TOV 500 /* msecs */
|
|
|
#define BFA_IOC_HB_TOV 500 /* msecs */
|
|
|
-#define BFA_IOC_HWINIT_MAX 5
|
|
|
#define BFA_IOC_TOV_RECOVER BFA_IOC_HB_TOV
|
|
|
+#define BFA_IOC_POLL_TOV BFA_TIMER_FREQ
|
|
|
|
|
|
#define bfa_ioc_timer_start(__ioc) \
|
|
|
bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->ioc_timer, \
|
|
|
@@ -79,14 +79,17 @@ bfa_boolean_t bfa_auto_recover = BFA_TRUE;
|
|
|
static void bfa_ioc_hw_sem_get(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force);
|
|
|
static void bfa_ioc_timeout(void *ioc);
|
|
|
+static void bfa_ioc_poll_fwinit(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_send_enable(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_send_disable(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_send_getattr(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_hb_monitor(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_mbox_poll(struct bfa_ioc_s *ioc);
|
|
|
-static void bfa_ioc_mbox_hbfail(struct bfa_ioc_s *ioc);
|
|
|
+static void bfa_ioc_mbox_flush(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_recover(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_check_attr_wwns(struct bfa_ioc_s *ioc);
|
|
|
+static void bfa_ioc_event_notify(struct bfa_ioc_s *ioc ,
|
|
|
+ enum bfa_ioc_event_e event);
|
|
|
static void bfa_ioc_disable_comp(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_lpu_stop(struct bfa_ioc_s *ioc);
|
|
|
static void bfa_ioc_debug_save_ftrc(struct bfa_ioc_s *ioc);
|
|
|
@@ -105,11 +108,12 @@ enum ioc_event {
|
|
|
IOC_E_ENABLED = 5, /* f/w enabled */
|
|
|
IOC_E_FWRSP_GETATTR = 6, /* IOC get attribute response */
|
|
|
IOC_E_DISABLED = 7, /* f/w disabled */
|
|
|
- IOC_E_INITFAILED = 8, /* failure notice by iocpf sm */
|
|
|
- IOC_E_PFFAILED = 9, /* failure notice by iocpf sm */
|
|
|
- IOC_E_HBFAIL = 10, /* heartbeat failure */
|
|
|
- IOC_E_HWERROR = 11, /* hardware error interrupt */
|
|
|
- IOC_E_TIMEOUT = 12, /* timeout */
|
|
|
+ IOC_E_PFFAILED = 8, /* failure notice by iocpf sm */
|
|
|
+ IOC_E_HBFAIL = 9, /* heartbeat failure */
|
|
|
+ IOC_E_HWERROR = 10, /* hardware error interrupt */
|
|
|
+ IOC_E_TIMEOUT = 11, /* timeout */
|
|
|
+ IOC_E_HWFAILED = 12, /* PCI mapping failure notice */
|
|
|
+ IOC_E_FWRSP_ACQ_ADDR = 13, /* Acquiring address */
|
|
|
};
|
|
|
|
|
|
bfa_fsm_state_decl(bfa_ioc, uninit, struct bfa_ioc_s, enum ioc_event);
|
|
|
@@ -121,6 +125,8 @@ bfa_fsm_state_decl(bfa_ioc, fail_retry, struct bfa_ioc_s, enum ioc_event);
|
|
|
bfa_fsm_state_decl(bfa_ioc, fail, struct bfa_ioc_s, enum ioc_event);
|
|
|
bfa_fsm_state_decl(bfa_ioc, disabling, struct bfa_ioc_s, enum ioc_event);
|
|
|
bfa_fsm_state_decl(bfa_ioc, disabled, struct bfa_ioc_s, enum ioc_event);
|
|
|
+bfa_fsm_state_decl(bfa_ioc, hwfail, struct bfa_ioc_s, enum ioc_event);
|
|
|
+bfa_fsm_state_decl(bfa_ioc, acq_addr, struct bfa_ioc_s, enum ioc_event);
|
|
|
|
|
|
static struct bfa_sm_table_s ioc_sm_table[] = {
|
|
|
{BFA_SM(bfa_ioc_sm_uninit), BFA_IOC_UNINIT},
|
|
|
@@ -132,6 +138,8 @@ static struct bfa_sm_table_s ioc_sm_table[] = {
|
|
|
{BFA_SM(bfa_ioc_sm_fail), BFA_IOC_FAIL},
|
|
|
{BFA_SM(bfa_ioc_sm_disabling), BFA_IOC_DISABLING},
|
|
|
{BFA_SM(bfa_ioc_sm_disabled), BFA_IOC_DISABLED},
|
|
|
+ {BFA_SM(bfa_ioc_sm_hwfail), BFA_IOC_HWFAIL},
|
|
|
+ {BFA_SM(bfa_ioc_sm_acq_addr), BFA_IOC_ACQ_ADDR},
|
|
|
};
|
|
|
|
|
|
/*
|
|
|
@@ -143,9 +151,9 @@ static struct bfa_sm_table_s ioc_sm_table[] = {
|
|
|
bfa_iocpf_timeout, (__ioc), BFA_IOC_TOV)
|
|
|
#define bfa_iocpf_timer_stop(__ioc) bfa_timer_stop(&(__ioc)->ioc_timer)
|
|
|
|
|
|
-#define bfa_iocpf_recovery_timer_start(__ioc) \
|
|
|
+#define bfa_iocpf_poll_timer_start(__ioc) \
|
|
|
bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->ioc_timer, \
|
|
|
- bfa_iocpf_timeout, (__ioc), BFA_IOC_TOV_RECOVER)
|
|
|
+ bfa_iocpf_poll_timeout, (__ioc), BFA_IOC_POLL_TOV)
|
|
|
|
|
|
#define bfa_sem_timer_start(__ioc) \
|
|
|
bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->sem_timer, \
|
|
|
@@ -157,6 +165,7 @@ static struct bfa_sm_table_s ioc_sm_table[] = {
|
|
|
*/
|
|
|
static void bfa_iocpf_timeout(void *ioc_arg);
|
|
|
static void bfa_iocpf_sem_timeout(void *ioc_arg);
|
|
|
+static void bfa_iocpf_poll_timeout(void *ioc_arg);
|
|
|
|
|
|
/*
|
|
|
* IOCPF state machine events
|
|
|
@@ -173,6 +182,7 @@ enum iocpf_event {
|
|
|
IOCPF_E_GETATTRFAIL = 9, /* init fail notice by ioc sm */
|
|
|
IOCPF_E_SEMLOCKED = 10, /* h/w semaphore is locked */
|
|
|
IOCPF_E_TIMEOUT = 11, /* f/w response timeout */
|
|
|
+ IOCPF_E_SEM_ERROR = 12, /* h/w sem mapping error */
|
|
|
};
|
|
|
|
|
|
/*
|
|
|
@@ -314,11 +324,16 @@ bfa_ioc_sm_enabling(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
/* !!! fall through !!! */
|
|
|
case IOC_E_HWERROR:
|
|
|
ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
- bfa_fsm_set_state(ioc, bfa_ioc_sm_fail_retry);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
|
|
|
if (event != IOC_E_PFFAILED)
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_INITFAIL);
|
|
|
break;
|
|
|
|
|
|
+ case IOC_E_HWFAILED:
|
|
|
+ ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_hwfail);
|
|
|
+ break;
|
|
|
+
|
|
|
case IOC_E_DISABLE:
|
|
|
bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
|
|
|
break;
|
|
|
@@ -356,17 +371,23 @@ bfa_ioc_sm_getattr(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
case IOC_E_FWRSP_GETATTR:
|
|
|
bfa_ioc_timer_stop(ioc);
|
|
|
bfa_ioc_check_attr_wwns(ioc);
|
|
|
+ bfa_ioc_hb_monitor(ioc);
|
|
|
bfa_fsm_set_state(ioc, bfa_ioc_sm_op);
|
|
|
break;
|
|
|
|
|
|
+ case IOC_E_FWRSP_ACQ_ADDR:
|
|
|
+ bfa_ioc_timer_stop(ioc);
|
|
|
+ bfa_ioc_hb_monitor(ioc);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_acq_addr);
|
|
|
break;
|
|
|
+
|
|
|
case IOC_E_PFFAILED:
|
|
|
case IOC_E_HWERROR:
|
|
|
bfa_ioc_timer_stop(ioc);
|
|
|
/* !!! fall through !!! */
|
|
|
case IOC_E_TIMEOUT:
|
|
|
ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
- bfa_fsm_set_state(ioc, bfa_ioc_sm_fail_retry);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
|
|
|
if (event != IOC_E_PFFAILED)
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_GETATTRFAIL);
|
|
|
break;
|
|
|
@@ -384,6 +405,50 @@ bfa_ioc_sm_getattr(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+/*
|
|
|
+ * Acquiring address from fabric (entry function)
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_ioc_sm_acq_addr_entry(struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Acquiring address from the fabric
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_ioc_sm_acq_addr(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
+{
|
|
|
+ bfa_trc(ioc, event);
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case IOC_E_FWRSP_GETATTR:
|
|
|
+ bfa_ioc_check_attr_wwns(ioc);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_op);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case IOC_E_PFFAILED:
|
|
|
+ case IOC_E_HWERROR:
|
|
|
+ bfa_hb_timer_stop(ioc);
|
|
|
+ case IOC_E_HBFAIL:
|
|
|
+ ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
|
|
|
+ if (event != IOC_E_PFFAILED)
|
|
|
+ bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_GETATTRFAIL);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case IOC_E_DISABLE:
|
|
|
+ bfa_hb_timer_stop(ioc);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case IOC_E_ENABLE:
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ bfa_sm_fault(ioc, event);
|
|
|
+ }
|
|
|
+}
|
|
|
|
|
|
static void
|
|
|
bfa_ioc_sm_op_entry(struct bfa_ioc_s *ioc)
|
|
|
@@ -391,7 +456,7 @@ bfa_ioc_sm_op_entry(struct bfa_ioc_s *ioc)
|
|
|
struct bfad_s *bfad = (struct bfad_s *)ioc->bfa->bfad;
|
|
|
|
|
|
ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_OK);
|
|
|
- bfa_ioc_hb_monitor(ioc);
|
|
|
+ bfa_ioc_event_notify(ioc, BFA_IOC_E_ENABLED);
|
|
|
BFA_LOG(KERN_INFO, bfad, bfa_log_level, "IOC enabled\n");
|
|
|
}
|
|
|
|
|
|
@@ -414,13 +479,13 @@ bfa_ioc_sm_op(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
bfa_hb_timer_stop(ioc);
|
|
|
/* !!! fall through !!! */
|
|
|
case IOC_E_HBFAIL:
|
|
|
- bfa_ioc_fail_notify(ioc);
|
|
|
-
|
|
|
if (ioc->iocpf.auto_recover)
|
|
|
bfa_fsm_set_state(ioc, bfa_ioc_sm_fail_retry);
|
|
|
else
|
|
|
bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
|
|
|
|
|
|
+ bfa_ioc_fail_notify(ioc);
|
|
|
+
|
|
|
if (event != IOC_E_PFFAILED)
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_FAIL);
|
|
|
break;
|
|
|
@@ -461,6 +526,11 @@ bfa_ioc_sm_disabling(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_FAIL);
|
|
|
break;
|
|
|
|
|
|
+ case IOC_E_HWFAILED:
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_hwfail);
|
|
|
+ bfa_ioc_disable_comp(ioc);
|
|
|
+ break;
|
|
|
+
|
|
|
default:
|
|
|
bfa_sm_fault(ioc, event);
|
|
|
}
|
|
|
@@ -525,12 +595,14 @@ bfa_ioc_sm_fail_retry(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
* Initialization retry failed.
|
|
|
*/
|
|
|
ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
|
|
|
if (event != IOC_E_PFFAILED)
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_INITFAIL);
|
|
|
break;
|
|
|
|
|
|
- case IOC_E_INITFAILED:
|
|
|
- bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
|
|
|
+ case IOC_E_HWFAILED:
|
|
|
+ ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_hwfail);
|
|
|
break;
|
|
|
|
|
|
case IOC_E_ENABLE:
|
|
|
@@ -590,6 +662,35 @@ bfa_ioc_sm_fail(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+static void
|
|
|
+bfa_ioc_sm_hwfail_entry(struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+ bfa_trc(ioc, 0);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_ioc_sm_hwfail(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
+{
|
|
|
+ bfa_trc(ioc, event);
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case IOC_E_ENABLE:
|
|
|
+ ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case IOC_E_DISABLE:
|
|
|
+ ioc->cbfn->disable_cbfn(ioc->bfa);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case IOC_E_DETACH:
|
|
|
+ bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ bfa_sm_fault(ioc, event);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
/*
|
|
|
* IOCPF State Machine
|
|
|
*/
|
|
|
@@ -600,7 +701,7 @@ bfa_ioc_sm_fail(struct bfa_ioc_s *ioc, enum ioc_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_reset_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
- iocpf->retry_count = 0;
|
|
|
+ iocpf->fw_mismatch_notified = BFA_FALSE;
|
|
|
iocpf->auto_recover = bfa_auto_recover;
|
|
|
}
|
|
|
|
|
|
@@ -633,6 +734,28 @@ bfa_iocpf_sm_reset(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_fwcheck_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
+ struct bfi_ioc_image_hdr_s fwhdr;
|
|
|
+ u32 fwstate = readl(iocpf->ioc->ioc_regs.ioc_fwstate);
|
|
|
+
|
|
|
+ /* h/w sem init */
|
|
|
+ if (fwstate == BFI_IOC_UNINIT)
|
|
|
+ goto sem_get;
|
|
|
+
|
|
|
+ bfa_ioc_fwver_get(iocpf->ioc, &fwhdr);
|
|
|
+
|
|
|
+ if (swab32(fwhdr.exec) == BFI_FWBOOT_TYPE_NORMAL)
|
|
|
+ goto sem_get;
|
|
|
+
|
|
|
+ bfa_trc(iocpf->ioc, fwstate);
|
|
|
+ bfa_trc(iocpf->ioc, fwhdr.exec);
|
|
|
+ writel(BFI_IOC_UNINIT, iocpf->ioc->ioc_regs.ioc_fwstate);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Try to lock and then unlock the semaphore.
|
|
|
+ */
|
|
|
+ readl(iocpf->ioc->ioc_regs.ioc_sem_reg);
|
|
|
+ writel(1, iocpf->ioc->ioc_regs.ioc_sem_reg);
|
|
|
+sem_get:
|
|
|
bfa_ioc_hw_sem_get(iocpf->ioc);
|
|
|
}
|
|
|
|
|
|
@@ -650,7 +773,6 @@ bfa_iocpf_sm_fwcheck(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
case IOCPF_E_SEMLOCKED:
|
|
|
if (bfa_ioc_firmware_lock(ioc)) {
|
|
|
if (bfa_ioc_sync_start(ioc)) {
|
|
|
- iocpf->retry_count = 0;
|
|
|
bfa_ioc_sync_join(ioc);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_hwinit);
|
|
|
} else {
|
|
|
@@ -664,6 +786,11 @@ bfa_iocpf_sm_fwcheck(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
}
|
|
|
break;
|
|
|
|
|
|
+ case IOCPF_E_SEM_ERROR:
|
|
|
+ bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_HWFAILED);
|
|
|
+ break;
|
|
|
+
|
|
|
case IOCPF_E_DISABLE:
|
|
|
bfa_sem_timer_stop(ioc);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
|
|
|
@@ -689,10 +816,10 @@ bfa_iocpf_sm_mismatch_entry(struct bfa_iocpf_s *iocpf)
|
|
|
/*
|
|
|
* Call only the first time sm enters fwmismatch state.
|
|
|
*/
|
|
|
- if (iocpf->retry_count == 0)
|
|
|
+ if (iocpf->fw_mismatch_notified == BFA_FALSE)
|
|
|
bfa_ioc_pf_fwmismatch(iocpf->ioc);
|
|
|
|
|
|
- iocpf->retry_count++;
|
|
|
+ iocpf->fw_mismatch_notified = BFA_TRUE;
|
|
|
bfa_iocpf_timer_start(iocpf->ioc);
|
|
|
}
|
|
|
|
|
|
@@ -757,6 +884,11 @@ bfa_iocpf_sm_semwait(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
}
|
|
|
break;
|
|
|
|
|
|
+ case IOCPF_E_SEM_ERROR:
|
|
|
+ bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_HWFAILED);
|
|
|
+ break;
|
|
|
+
|
|
|
case IOCPF_E_DISABLE:
|
|
|
bfa_sem_timer_stop(ioc);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabling_sync);
|
|
|
@@ -770,7 +902,7 @@ bfa_iocpf_sm_semwait(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_hwinit_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
- bfa_iocpf_timer_start(iocpf->ioc);
|
|
|
+ iocpf->poll_time = 0;
|
|
|
bfa_ioc_hwinit(iocpf->ioc, BFA_FALSE);
|
|
|
}
|
|
|
|
|
|
@@ -787,20 +919,12 @@ bfa_iocpf_sm_hwinit(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
|
|
|
switch (event) {
|
|
|
case IOCPF_E_FWREADY:
|
|
|
- bfa_iocpf_timer_stop(ioc);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_enabling);
|
|
|
break;
|
|
|
|
|
|
- case IOCPF_E_INITFAIL:
|
|
|
- bfa_iocpf_timer_stop(ioc);
|
|
|
- /*
|
|
|
- * !!! fall through !!!
|
|
|
- */
|
|
|
-
|
|
|
case IOCPF_E_TIMEOUT:
|
|
|
writel(1, ioc->ioc_regs.ioc_sem_reg);
|
|
|
- if (event == IOCPF_E_TIMEOUT)
|
|
|
- bfa_fsm_send_event(ioc, IOC_E_PFFAILED);
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_PFFAILED);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail_sync);
|
|
|
break;
|
|
|
|
|
|
@@ -820,6 +944,10 @@ static void
|
|
|
bfa_iocpf_sm_enabling_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
bfa_iocpf_timer_start(iocpf->ioc);
|
|
|
+ /*
|
|
|
+ * Enable Interrupts before sending fw IOC ENABLE cmd.
|
|
|
+ */
|
|
|
+ iocpf->ioc->cbfn->reset_cbfn(iocpf->ioc->bfa);
|
|
|
bfa_ioc_send_enable(iocpf->ioc);
|
|
|
}
|
|
|
|
|
|
@@ -860,10 +988,6 @@ bfa_iocpf_sm_enabling(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabling);
|
|
|
break;
|
|
|
|
|
|
- case IOCPF_E_FWREADY:
|
|
|
- bfa_ioc_send_enable(ioc);
|
|
|
- break;
|
|
|
-
|
|
|
default:
|
|
|
bfa_sm_fault(ioc, event);
|
|
|
}
|
|
|
@@ -895,16 +1019,6 @@ bfa_iocpf_sm_ready(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail_sync);
|
|
|
break;
|
|
|
|
|
|
- case IOCPF_E_FWREADY:
|
|
|
- if (bfa_ioc_is_operational(ioc)) {
|
|
|
- bfa_fsm_send_event(ioc, IOC_E_PFFAILED);
|
|
|
- bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail_sync);
|
|
|
- } else {
|
|
|
- bfa_fsm_send_event(ioc, IOC_E_PFFAILED);
|
|
|
- bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail_sync);
|
|
|
- }
|
|
|
- break;
|
|
|
-
|
|
|
default:
|
|
|
bfa_sm_fault(ioc, event);
|
|
|
}
|
|
|
@@ -929,7 +1043,6 @@ bfa_iocpf_sm_disabling(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
|
|
|
switch (event) {
|
|
|
case IOCPF_E_FWRSP_DISABLE:
|
|
|
- case IOCPF_E_FWREADY:
|
|
|
bfa_iocpf_timer_stop(ioc);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabling_sync);
|
|
|
break;
|
|
|
@@ -976,6 +1089,11 @@ bfa_iocpf_sm_disabling_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
|
|
|
break;
|
|
|
|
|
|
+ case IOCPF_E_SEM_ERROR:
|
|
|
+ bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_HWFAILED);
|
|
|
+ break;
|
|
|
+
|
|
|
case IOCPF_E_FAIL:
|
|
|
break;
|
|
|
|
|
|
@@ -990,6 +1108,7 @@ bfa_iocpf_sm_disabling_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_disabled_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
+ bfa_ioc_mbox_flush(iocpf->ioc);
|
|
|
bfa_fsm_send_event(iocpf->ioc, IOC_E_DISABLED);
|
|
|
}
|
|
|
|
|
|
@@ -1002,7 +1121,6 @@ bfa_iocpf_sm_disabled(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
|
|
|
switch (event) {
|
|
|
case IOCPF_E_ENABLE:
|
|
|
- iocpf->retry_count = 0;
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_semwait);
|
|
|
break;
|
|
|
|
|
|
@@ -1019,6 +1137,7 @@ bfa_iocpf_sm_disabled(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_initfail_sync_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
+ bfa_ioc_debug_save_ftrc(iocpf->ioc);
|
|
|
bfa_ioc_hw_sem_get(iocpf->ioc);
|
|
|
}
|
|
|
|
|
|
@@ -1035,20 +1154,15 @@ bfa_iocpf_sm_initfail_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
switch (event) {
|
|
|
case IOCPF_E_SEMLOCKED:
|
|
|
bfa_ioc_notify_fail(ioc);
|
|
|
- bfa_ioc_sync_ack(ioc);
|
|
|
- iocpf->retry_count++;
|
|
|
- if (iocpf->retry_count >= BFA_IOC_HWINIT_MAX) {
|
|
|
- bfa_ioc_sync_leave(ioc);
|
|
|
- writel(1, ioc->ioc_regs.ioc_sem_reg);
|
|
|
- bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail);
|
|
|
- } else {
|
|
|
- if (bfa_ioc_sync_complete(ioc))
|
|
|
- bfa_fsm_set_state(iocpf, bfa_iocpf_sm_hwinit);
|
|
|
- else {
|
|
|
- writel(1, ioc->ioc_regs.ioc_sem_reg);
|
|
|
- bfa_fsm_set_state(iocpf, bfa_iocpf_sm_semwait);
|
|
|
- }
|
|
|
- }
|
|
|
+ bfa_ioc_sync_leave(ioc);
|
|
|
+ writel(BFI_IOC_FAIL, ioc->ioc_regs.ioc_fwstate);
|
|
|
+ writel(1, ioc->ioc_regs.ioc_sem_reg);
|
|
|
+ bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case IOCPF_E_SEM_ERROR:
|
|
|
+ bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_HWFAILED);
|
|
|
break;
|
|
|
|
|
|
case IOCPF_E_DISABLE:
|
|
|
@@ -1073,7 +1187,7 @@ bfa_iocpf_sm_initfail_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_initfail_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
- bfa_fsm_send_event(iocpf->ioc, IOC_E_INITFAILED);
|
|
|
+ bfa_trc(iocpf->ioc, 0);
|
|
|
}
|
|
|
|
|
|
/*
|
|
|
@@ -1112,7 +1226,7 @@ bfa_iocpf_sm_fail_sync_entry(struct bfa_iocpf_s *iocpf)
|
|
|
/*
|
|
|
* Flush any queued up mailbox requests.
|
|
|
*/
|
|
|
- bfa_ioc_mbox_hbfail(iocpf->ioc);
|
|
|
+ bfa_ioc_mbox_flush(iocpf->ioc);
|
|
|
|
|
|
bfa_ioc_hw_sem_get(iocpf->ioc);
|
|
|
}
|
|
|
@@ -1126,11 +1240,11 @@ bfa_iocpf_sm_fail_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
|
|
|
switch (event) {
|
|
|
case IOCPF_E_SEMLOCKED:
|
|
|
- iocpf->retry_count = 0;
|
|
|
bfa_ioc_sync_ack(ioc);
|
|
|
bfa_ioc_notify_fail(ioc);
|
|
|
if (!iocpf->auto_recover) {
|
|
|
bfa_ioc_sync_leave(ioc);
|
|
|
+ writel(BFI_IOC_FAIL, ioc->ioc_regs.ioc_fwstate);
|
|
|
writel(1, ioc->ioc_regs.ioc_sem_reg);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
|
|
|
} else {
|
|
|
@@ -1143,6 +1257,11 @@ bfa_iocpf_sm_fail_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
}
|
|
|
break;
|
|
|
|
|
|
+ case IOCPF_E_SEM_ERROR:
|
|
|
+ bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_HWFAILED);
|
|
|
+ break;
|
|
|
+
|
|
|
case IOCPF_E_DISABLE:
|
|
|
bfa_sem_timer_stop(ioc);
|
|
|
bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabling_sync);
|
|
|
@@ -1159,6 +1278,7 @@ bfa_iocpf_sm_fail_sync(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
static void
|
|
|
bfa_iocpf_sm_fail_entry(struct bfa_iocpf_s *iocpf)
|
|
|
{
|
|
|
+ bfa_trc(iocpf->ioc, 0);
|
|
|
}
|
|
|
|
|
|
/*
|
|
|
@@ -1185,23 +1305,28 @@ bfa_iocpf_sm_fail(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
|
|
|
* BFA IOC private functions
|
|
|
*/
|
|
|
|
|
|
+/*
|
|
|
+ * Notify common modules registered for notification.
|
|
|
+ */
|
|
|
static void
|
|
|
-bfa_ioc_disable_comp(struct bfa_ioc_s *ioc)
|
|
|
+bfa_ioc_event_notify(struct bfa_ioc_s *ioc, enum bfa_ioc_event_e event)
|
|
|
{
|
|
|
- struct list_head *qe;
|
|
|
- struct bfa_ioc_hbfail_notify_s *notify;
|
|
|
-
|
|
|
- ioc->cbfn->disable_cbfn(ioc->bfa);
|
|
|
+ struct bfa_ioc_notify_s *notify;
|
|
|
+ struct list_head *qe;
|
|
|
|
|
|
- /*
|
|
|
- * Notify common modules registered for notification.
|
|
|
- */
|
|
|
- list_for_each(qe, &ioc->hb_notify_q) {
|
|
|
- notify = (struct bfa_ioc_hbfail_notify_s *) qe;
|
|
|
- notify->cbfn(notify->cbarg);
|
|
|
+ list_for_each(qe, &ioc->notify_q) {
|
|
|
+ notify = (struct bfa_ioc_notify_s *)qe;
|
|
|
+ notify->cbfn(notify->cbarg, event);
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+static void
|
|
|
+bfa_ioc_disable_comp(struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+ ioc->cbfn->disable_cbfn(ioc->bfa);
|
|
|
+ bfa_ioc_event_notify(ioc, BFA_IOC_E_DISABLED);
|
|
|
+}
|
|
|
+
|
|
|
bfa_boolean_t
|
|
|
bfa_ioc_sem_get(void __iomem *sem_reg)
|
|
|
{
|
|
|
@@ -1211,16 +1336,15 @@ bfa_ioc_sem_get(void __iomem *sem_reg)
|
|
|
|
|
|
r32 = readl(sem_reg);
|
|
|
|
|
|
- while (r32 && (cnt < BFA_SEM_SPINCNT)) {
|
|
|
+ while ((r32 & 1) && (cnt < BFA_SEM_SPINCNT)) {
|
|
|
cnt++;
|
|
|
udelay(2);
|
|
|
r32 = readl(sem_reg);
|
|
|
}
|
|
|
|
|
|
- if (r32 == 0)
|
|
|
+ if (!(r32 & 1))
|
|
|
return BFA_TRUE;
|
|
|
|
|
|
- WARN_ON(cnt >= BFA_SEM_SPINCNT);
|
|
|
return BFA_FALSE;
|
|
|
}
|
|
|
|
|
|
@@ -1234,7 +1358,12 @@ bfa_ioc_hw_sem_get(struct bfa_ioc_s *ioc)
|
|
|
* will return 1. Semaphore is released by writing 1 to the register
|
|
|
*/
|
|
|
r32 = readl(ioc->ioc_regs.ioc_sem_reg);
|
|
|
- if (r32 == 0) {
|
|
|
+ if (r32 == ~0) {
|
|
|
+ WARN_ON(r32 == ~0);
|
|
|
+ bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_SEM_ERROR);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (!(r32 & 1)) {
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_SEMLOCKED);
|
|
|
return;
|
|
|
}
|
|
|
@@ -1343,7 +1472,7 @@ bfa_ioc_fwver_cmp(struct bfa_ioc_s *ioc, struct bfi_ioc_image_hdr_s *fwhdr)
|
|
|
int i;
|
|
|
|
|
|
drv_fwhdr = (struct bfi_ioc_image_hdr_s *)
|
|
|
- bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc), 0);
|
|
|
+ bfa_cb_image_get_chunk(bfa_ioc_asic_gen(ioc), 0);
|
|
|
|
|
|
for (i = 0; i < BFI_IOC_MD5SUM_SZ; i++) {
|
|
|
if (fwhdr->md5sum[i] != drv_fwhdr->md5sum[i]) {
|
|
|
@@ -1369,7 +1498,7 @@ bfa_ioc_fwver_valid(struct bfa_ioc_s *ioc, u32 boot_env)
|
|
|
|
|
|
bfa_ioc_fwver_get(ioc, &fwhdr);
|
|
|
drv_fwhdr = (struct bfi_ioc_image_hdr_s *)
|
|
|
- bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc), 0);
|
|
|
+ bfa_cb_image_get_chunk(bfa_ioc_asic_gen(ioc), 0);
|
|
|
|
|
|
if (fwhdr.signature != drv_fwhdr->signature) {
|
|
|
bfa_trc(ioc, fwhdr.signature);
|
|
|
@@ -1377,8 +1506,8 @@ bfa_ioc_fwver_valid(struct bfa_ioc_s *ioc, u32 boot_env)
|
|
|
return BFA_FALSE;
|
|
|
}
|
|
|
|
|
|
- if (swab32(fwhdr.param) != boot_env) {
|
|
|
- bfa_trc(ioc, fwhdr.param);
|
|
|
+ if (swab32(fwhdr.bootenv) != boot_env) {
|
|
|
+ bfa_trc(ioc, fwhdr.bootenv);
|
|
|
bfa_trc(ioc, boot_env);
|
|
|
return BFA_FALSE;
|
|
|
}
|
|
|
@@ -1414,8 +1543,8 @@ bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force)
|
|
|
|
|
|
bfa_trc(ioc, ioc_fwstate);
|
|
|
|
|
|
- boot_type = BFI_BOOT_TYPE_NORMAL;
|
|
|
- boot_env = BFI_BOOT_LOADER_OS;
|
|
|
+ boot_type = BFI_FWBOOT_TYPE_NORMAL;
|
|
|
+ boot_env = BFI_FWBOOT_ENV_OS;
|
|
|
|
|
|
/*
|
|
|
* check if firmware is valid
|
|
|
@@ -1425,6 +1554,7 @@ bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force)
|
|
|
|
|
|
if (!fwvalid) {
|
|
|
bfa_ioc_boot(ioc, boot_type, boot_env);
|
|
|
+ bfa_ioc_poll_fwinit(ioc);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
@@ -1433,7 +1563,7 @@ bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force)
|
|
|
* just wait for an initialization completion interrupt.
|
|
|
*/
|
|
|
if (ioc_fwstate == BFI_IOC_INITING) {
|
|
|
- ioc->cbfn->reset_cbfn(ioc->bfa);
|
|
|
+ bfa_ioc_poll_fwinit(ioc);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
@@ -1452,7 +1582,6 @@ bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force)
|
|
|
* be flushed. Otherwise MSI-X interrupts are not delivered.
|
|
|
*/
|
|
|
bfa_ioc_msgflush(ioc);
|
|
|
- ioc->cbfn->reset_cbfn(ioc->bfa);
|
|
|
bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_FWREADY);
|
|
|
return;
|
|
|
}
|
|
|
@@ -1461,6 +1590,7 @@ bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force)
|
|
|
* Initialize the h/w for any other states.
|
|
|
*/
|
|
|
bfa_ioc_boot(ioc, boot_type, boot_env);
|
|
|
+ bfa_ioc_poll_fwinit(ioc);
|
|
|
}
|
|
|
|
|
|
static void
|
|
|
@@ -1508,7 +1638,7 @@ bfa_ioc_send_enable(struct bfa_ioc_s *ioc)
|
|
|
|
|
|
bfi_h2i_set(enable_req.mh, BFI_MC_IOC, BFI_IOC_H2I_ENABLE_REQ,
|
|
|
bfa_ioc_portid(ioc));
|
|
|
- enable_req.ioc_class = ioc->ioc_mc;
|
|
|
+ enable_req.clscode = cpu_to_be16(ioc->clscode);
|
|
|
do_gettimeofday(&tv);
|
|
|
enable_req.tv_sec = be32_to_cpu(tv.tv_sec);
|
|
|
bfa_ioc_mbox_send(ioc, &enable_req, sizeof(struct bfi_ioc_ctrl_req_s));
|
|
|
@@ -1572,25 +1702,26 @@ bfa_ioc_download_fw(struct bfa_ioc_s *ioc, u32 boot_type,
|
|
|
u32 loff = 0;
|
|
|
u32 chunkno = 0;
|
|
|
u32 i;
|
|
|
+ u32 asicmode;
|
|
|
|
|
|
/*
|
|
|
* Initialize LMEM first before code download
|
|
|
*/
|
|
|
bfa_ioc_lmem_init(ioc);
|
|
|
|
|
|
- bfa_trc(ioc, bfa_cb_image_get_size(BFA_IOC_FWIMG_TYPE(ioc)));
|
|
|
- fwimg = bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc), chunkno);
|
|
|
+ bfa_trc(ioc, bfa_cb_image_get_size(bfa_ioc_asic_gen(ioc)));
|
|
|
+ fwimg = bfa_cb_image_get_chunk(bfa_ioc_asic_gen(ioc), chunkno);
|
|
|
|
|
|
pgnum = PSS_SMEM_PGNUM(ioc->ioc_regs.smem_pg0, loff);
|
|
|
pgoff = PSS_SMEM_PGOFF(loff);
|
|
|
|
|
|
writel(pgnum, ioc->ioc_regs.host_page_num_fn);
|
|
|
|
|
|
- for (i = 0; i < bfa_cb_image_get_size(BFA_IOC_FWIMG_TYPE(ioc)); i++) {
|
|
|
+ for (i = 0; i < bfa_cb_image_get_size(bfa_ioc_asic_gen(ioc)); i++) {
|
|
|
|
|
|
if (BFA_IOC_FLASH_CHUNK_NO(i) != chunkno) {
|
|
|
chunkno = BFA_IOC_FLASH_CHUNK_NO(i);
|
|
|
- fwimg = bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc),
|
|
|
+ fwimg = bfa_cb_image_get_chunk(bfa_ioc_asic_gen(ioc),
|
|
|
BFA_IOC_FLASH_CHUNK_ADDR(chunkno));
|
|
|
}
|
|
|
|
|
|
@@ -1616,11 +1747,15 @@ bfa_ioc_download_fw(struct bfa_ioc_s *ioc, u32 boot_type,
|
|
|
ioc->ioc_regs.host_page_num_fn);
|
|
|
|
|
|
/*
|
|
|
- * Set boot type and boot param at the end.
|
|
|
- */
|
|
|
- bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_BOOT_TYPE_OFF,
|
|
|
+ * Set boot type and device mode at the end.
|
|
|
+ */
|
|
|
+ asicmode = BFI_FWBOOT_DEVMODE(ioc->asic_gen, ioc->asic_mode,
|
|
|
+ ioc->port0_mode, ioc->port1_mode);
|
|
|
+ bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_FWBOOT_DEVMODE_OFF,
|
|
|
+ swab32(asicmode));
|
|
|
+ bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_FWBOOT_TYPE_OFF,
|
|
|
swab32(boot_type));
|
|
|
- bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_BOOT_LOADER_OFF,
|
|
|
+ bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_FWBOOT_ENV_OFF,
|
|
|
swab32(boot_env));
|
|
|
}
|
|
|
|
|
|
@@ -1636,6 +1771,7 @@ bfa_ioc_getattr_reply(struct bfa_ioc_s *ioc)
|
|
|
attr->adapter_prop = be32_to_cpu(attr->adapter_prop);
|
|
|
attr->card_type = be32_to_cpu(attr->card_type);
|
|
|
attr->maxfrsize = be16_to_cpu(attr->maxfrsize);
|
|
|
+ ioc->fcmode = (attr->port_mode == BFI_PORT_MODE_FC);
|
|
|
|
|
|
bfa_fsm_send_event(ioc, IOC_E_FWRSP_GETATTR);
|
|
|
}
|
|
|
@@ -1690,7 +1826,7 @@ bfa_ioc_mbox_poll(struct bfa_ioc_s *ioc)
|
|
|
* Cleanup any pending requests.
|
|
|
*/
|
|
|
static void
|
|
|
-bfa_ioc_mbox_hbfail(struct bfa_ioc_s *ioc)
|
|
|
+bfa_ioc_mbox_flush(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
struct bfa_ioc_mbox_mod_s *mod = &ioc->mbox_mod;
|
|
|
struct bfa_mbox_cmd_s *cmd;
|
|
|
@@ -1752,6 +1888,7 @@ bfa_ioc_smem_read(struct bfa_ioc_s *ioc, void *tbuf, u32 soff, u32 sz)
|
|
|
/*
|
|
|
* release semaphore.
|
|
|
*/
|
|
|
+ readl(ioc->ioc_regs.ioc_init_sem_reg);
|
|
|
writel(1, ioc->ioc_regs.ioc_init_sem_reg);
|
|
|
|
|
|
bfa_trc(ioc, pgnum);
|
|
|
@@ -1808,6 +1945,7 @@ bfa_ioc_smem_clr(struct bfa_ioc_s *ioc, u32 soff, u32 sz)
|
|
|
/*
|
|
|
* release semaphore.
|
|
|
*/
|
|
|
+ readl(ioc->ioc_regs.ioc_init_sem_reg);
|
|
|
writel(1, ioc->ioc_regs.ioc_init_sem_reg);
|
|
|
bfa_trc(ioc, pgnum);
|
|
|
return BFA_STATUS_OK;
|
|
|
@@ -1816,18 +1954,13 @@ bfa_ioc_smem_clr(struct bfa_ioc_s *ioc, u32 soff, u32 sz)
|
|
|
static void
|
|
|
bfa_ioc_fail_notify(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
- struct list_head *qe;
|
|
|
- struct bfa_ioc_hbfail_notify_s *notify;
|
|
|
struct bfad_s *bfad = (struct bfad_s *)ioc->bfa->bfad;
|
|
|
|
|
|
/*
|
|
|
* Notify driver and common modules registered for notification.
|
|
|
*/
|
|
|
ioc->cbfn->hbfail_cbfn(ioc->bfa);
|
|
|
- list_for_each(qe, &ioc->hb_notify_q) {
|
|
|
- notify = (struct bfa_ioc_hbfail_notify_s *) qe;
|
|
|
- notify->cbfn(notify->cbarg);
|
|
|
- }
|
|
|
+ bfa_ioc_event_notify(ioc, BFA_IOC_E_FAILED);
|
|
|
|
|
|
bfa_ioc_debug_save_ftrc(ioc);
|
|
|
|
|
|
@@ -1864,6 +1997,7 @@ bfa_ioc_pll_init(struct bfa_ioc_s *ioc)
|
|
|
/*
|
|
|
* release semaphore.
|
|
|
*/
|
|
|
+ readl(ioc->ioc_regs.ioc_init_sem_reg);
|
|
|
writel(1, ioc->ioc_regs.ioc_init_sem_reg);
|
|
|
|
|
|
return BFA_STATUS_OK;
|
|
|
@@ -1876,8 +2010,6 @@ bfa_ioc_pll_init(struct bfa_ioc_s *ioc)
|
|
|
void
|
|
|
bfa_ioc_boot(struct bfa_ioc_s *ioc, u32 boot_type, u32 boot_env)
|
|
|
{
|
|
|
- void __iomem *rb;
|
|
|
-
|
|
|
bfa_ioc_stats(ioc, ioc_boots);
|
|
|
|
|
|
if (bfa_ioc_pll_init(ioc) != BFA_STATUS_OK)
|
|
|
@@ -1886,22 +2018,16 @@ bfa_ioc_boot(struct bfa_ioc_s *ioc, u32 boot_type, u32 boot_env)
|
|
|
/*
|
|
|
* Initialize IOC state of all functions on a chip reset.
|
|
|
*/
|
|
|
- rb = ioc->pcidev.pci_bar_kva;
|
|
|
- if (boot_type == BFI_BOOT_TYPE_MEMTEST) {
|
|
|
- writel(BFI_IOC_MEMTEST, (rb + BFA_IOC0_STATE_REG));
|
|
|
- writel(BFI_IOC_MEMTEST, (rb + BFA_IOC1_STATE_REG));
|
|
|
+ if (boot_type == BFI_FWBOOT_TYPE_MEMTEST) {
|
|
|
+ writel(BFI_IOC_MEMTEST, ioc->ioc_regs.ioc_fwstate);
|
|
|
+ writel(BFI_IOC_MEMTEST, ioc->ioc_regs.alt_ioc_fwstate);
|
|
|
} else {
|
|
|
- writel(BFI_IOC_INITING, (rb + BFA_IOC0_STATE_REG));
|
|
|
- writel(BFI_IOC_INITING, (rb + BFA_IOC1_STATE_REG));
|
|
|
+ writel(BFI_IOC_INITING, ioc->ioc_regs.ioc_fwstate);
|
|
|
+ writel(BFI_IOC_INITING, ioc->ioc_regs.alt_ioc_fwstate);
|
|
|
}
|
|
|
|
|
|
bfa_ioc_msgflush(ioc);
|
|
|
bfa_ioc_download_fw(ioc, boot_type, boot_env);
|
|
|
-
|
|
|
- /*
|
|
|
- * Enable interrupts just before starting LPU
|
|
|
- */
|
|
|
- ioc->cbfn->reset_cbfn(ioc->bfa);
|
|
|
bfa_ioc_lpu_start(ioc);
|
|
|
}
|
|
|
|
|
|
@@ -1932,13 +2058,17 @@ bfa_ioc_is_initialized(struct bfa_ioc_s *ioc)
|
|
|
(r32 != BFI_IOC_MEMTEST));
|
|
|
}
|
|
|
|
|
|
-void
|
|
|
+bfa_boolean_t
|
|
|
bfa_ioc_msgget(struct bfa_ioc_s *ioc, void *mbmsg)
|
|
|
{
|
|
|
__be32 *msgp = mbmsg;
|
|
|
u32 r32;
|
|
|
int i;
|
|
|
|
|
|
+ r32 = readl(ioc->ioc_regs.lpu_mbox_cmd);
|
|
|
+ if ((r32 & 1) == 0)
|
|
|
+ return BFA_FALSE;
|
|
|
+
|
|
|
/*
|
|
|
* read the MBOX msg
|
|
|
*/
|
|
|
@@ -1954,6 +2084,8 @@ bfa_ioc_msgget(struct bfa_ioc_s *ioc, void *mbmsg)
|
|
|
*/
|
|
|
writel(1, ioc->ioc_regs.lpu_mbox_cmd);
|
|
|
readl(ioc->ioc_regs.lpu_mbox_cmd);
|
|
|
+
|
|
|
+ return BFA_TRUE;
|
|
|
}
|
|
|
|
|
|
void
|
|
|
@@ -1970,11 +2102,10 @@ bfa_ioc_isr(struct bfa_ioc_s *ioc, struct bfi_mbmsg_s *m)
|
|
|
case BFI_IOC_I2H_HBEAT:
|
|
|
break;
|
|
|
|
|
|
- case BFI_IOC_I2H_READY_EVENT:
|
|
|
- bfa_fsm_send_event(iocpf, IOCPF_E_FWREADY);
|
|
|
- break;
|
|
|
-
|
|
|
case BFI_IOC_I2H_ENABLE_REPLY:
|
|
|
+ ioc->port_mode = ioc->port_mode_cfg =
|
|
|
+ (enum bfa_mode_s)msg->fw_event.port_mode;
|
|
|
+ ioc->ad_cap_bm = msg->fw_event.cap_bm;
|
|
|
bfa_fsm_send_event(iocpf, IOCPF_E_FWRSP_ENABLE);
|
|
|
break;
|
|
|
|
|
|
@@ -1986,6 +2117,10 @@ bfa_ioc_isr(struct bfa_ioc_s *ioc, struct bfi_mbmsg_s *m)
|
|
|
bfa_ioc_getattr_reply(ioc);
|
|
|
break;
|
|
|
|
|
|
+ case BFI_IOC_I2H_ACQ_ADDR_REPLY:
|
|
|
+ bfa_fsm_send_event(ioc, IOC_E_FWRSP_ACQ_ADDR);
|
|
|
+ break;
|
|
|
+
|
|
|
default:
|
|
|
bfa_trc(ioc, msg->mh.msg_id);
|
|
|
WARN_ON(1);
|
|
|
@@ -2011,7 +2146,7 @@ bfa_ioc_attach(struct bfa_ioc_s *ioc, void *bfa, struct bfa_ioc_cbfn_s *cbfn,
|
|
|
ioc->iocpf.ioc = ioc;
|
|
|
|
|
|
bfa_ioc_mbox_attach(ioc);
|
|
|
- INIT_LIST_HEAD(&ioc->hb_notify_q);
|
|
|
+ INIT_LIST_HEAD(&ioc->notify_q);
|
|
|
|
|
|
bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
|
|
|
bfa_fsm_send_event(ioc, IOC_E_RESET);
|
|
|
@@ -2024,6 +2159,7 @@ void
|
|
|
bfa_ioc_detach(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
bfa_fsm_send_event(ioc, IOC_E_DETACH);
|
|
|
+ INIT_LIST_HEAD(&ioc->notify_q);
|
|
|
}
|
|
|
|
|
|
/*
|
|
|
@@ -2033,20 +2169,80 @@ bfa_ioc_detach(struct bfa_ioc_s *ioc)
|
|
|
*/
|
|
|
void
|
|
|
bfa_ioc_pci_init(struct bfa_ioc_s *ioc, struct bfa_pcidev_s *pcidev,
|
|
|
- enum bfi_mclass mc)
|
|
|
+ enum bfi_pcifn_class clscode)
|
|
|
{
|
|
|
- ioc->ioc_mc = mc;
|
|
|
+ ioc->clscode = clscode;
|
|
|
ioc->pcidev = *pcidev;
|
|
|
- ioc->ctdev = bfa_asic_id_ct(ioc->pcidev.device_id);
|
|
|
- ioc->cna = ioc->ctdev && !ioc->fcmode;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Initialize IOC and device personality
|
|
|
+ */
|
|
|
+ ioc->port0_mode = ioc->port1_mode = BFI_PORT_MODE_FC;
|
|
|
+ ioc->asic_mode = BFI_ASIC_MODE_FC;
|
|
|
+
|
|
|
+ switch (pcidev->device_id) {
|
|
|
+ case BFA_PCI_DEVICE_ID_FC_8G1P:
|
|
|
+ case BFA_PCI_DEVICE_ID_FC_8G2P:
|
|
|
+ ioc->asic_gen = BFI_ASIC_GEN_CB;
|
|
|
+ ioc->fcmode = BFA_TRUE;
|
|
|
+ ioc->port_mode = ioc->port_mode_cfg = BFA_MODE_HBA;
|
|
|
+ ioc->ad_cap_bm = BFA_CM_HBA;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFA_PCI_DEVICE_ID_CT:
|
|
|
+ ioc->asic_gen = BFI_ASIC_GEN_CT;
|
|
|
+ ioc->port0_mode = ioc->port1_mode = BFI_PORT_MODE_ETH;
|
|
|
+ ioc->asic_mode = BFI_ASIC_MODE_ETH;
|
|
|
+ ioc->port_mode = ioc->port_mode_cfg = BFA_MODE_CNA;
|
|
|
+ ioc->ad_cap_bm = BFA_CM_CNA;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFA_PCI_DEVICE_ID_CT_FC:
|
|
|
+ ioc->asic_gen = BFI_ASIC_GEN_CT;
|
|
|
+ ioc->fcmode = BFA_TRUE;
|
|
|
+ ioc->port_mode = ioc->port_mode_cfg = BFA_MODE_HBA;
|
|
|
+ ioc->ad_cap_bm = BFA_CM_HBA;
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFA_PCI_DEVICE_ID_CT2:
|
|
|
+ ioc->asic_gen = BFI_ASIC_GEN_CT2;
|
|
|
+ if (clscode == BFI_PCIFN_CLASS_FC &&
|
|
|
+ pcidev->ssid == BFA_PCI_CT2_SSID_FC) {
|
|
|
+ ioc->asic_mode = BFI_ASIC_MODE_FC16;
|
|
|
+ ioc->fcmode = BFA_TRUE;
|
|
|
+ ioc->port_mode = ioc->port_mode_cfg = BFA_MODE_HBA;
|
|
|
+ ioc->ad_cap_bm = BFA_CM_HBA;
|
|
|
+ } else {
|
|
|
+ ioc->port0_mode = ioc->port1_mode = BFI_PORT_MODE_ETH;
|
|
|
+ ioc->asic_mode = BFI_ASIC_MODE_ETH;
|
|
|
+ if (pcidev->ssid == BFA_PCI_CT2_SSID_FCoE) {
|
|
|
+ ioc->port_mode =
|
|
|
+ ioc->port_mode_cfg = BFA_MODE_CNA;
|
|
|
+ ioc->ad_cap_bm = BFA_CM_CNA;
|
|
|
+ } else {
|
|
|
+ ioc->port_mode =
|
|
|
+ ioc->port_mode_cfg = BFA_MODE_NIC;
|
|
|
+ ioc->ad_cap_bm = BFA_CM_NIC;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ }
|
|
|
|
|
|
/*
|
|
|
* Set asic specific interfaces. See bfa_ioc_cb.c and bfa_ioc_ct.c
|
|
|
*/
|
|
|
- if (ioc->ctdev)
|
|
|
- bfa_ioc_set_ct_hwif(ioc);
|
|
|
- else
|
|
|
+ if (ioc->asic_gen == BFI_ASIC_GEN_CB)
|
|
|
bfa_ioc_set_cb_hwif(ioc);
|
|
|
+ else if (ioc->asic_gen == BFI_ASIC_GEN_CT)
|
|
|
+ bfa_ioc_set_ct_hwif(ioc);
|
|
|
+ else {
|
|
|
+ WARN_ON(ioc->asic_gen != BFI_ASIC_GEN_CT2);
|
|
|
+ bfa_ioc_set_ct2_hwif(ioc);
|
|
|
+ bfa_ioc_ct2_poweron(ioc);
|
|
|
+ }
|
|
|
|
|
|
bfa_ioc_map_port(ioc);
|
|
|
bfa_ioc_reg_init(ioc);
|
|
|
@@ -2172,36 +2368,38 @@ bfa_ioc_mbox_isr(struct bfa_ioc_s *ioc)
|
|
|
struct bfi_mbmsg_s m;
|
|
|
int mc;
|
|
|
|
|
|
- bfa_ioc_msgget(ioc, &m);
|
|
|
+ if (bfa_ioc_msgget(ioc, &m)) {
|
|
|
+ /*
|
|
|
+ * Treat IOC message class as special.
|
|
|
+ */
|
|
|
+ mc = m.mh.msg_class;
|
|
|
+ if (mc == BFI_MC_IOC) {
|
|
|
+ bfa_ioc_isr(ioc, &m);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((mc > BFI_MC_MAX) || (mod->mbhdlr[mc].cbfn == NULL))
|
|
|
+ return;
|
|
|
|
|
|
- /*
|
|
|
- * Treat IOC message class as special.
|
|
|
- */
|
|
|
- mc = m.mh.msg_class;
|
|
|
- if (mc == BFI_MC_IOC) {
|
|
|
- bfa_ioc_isr(ioc, &m);
|
|
|
- return;
|
|
|
+ mod->mbhdlr[mc].cbfn(mod->mbhdlr[mc].cbarg, &m);
|
|
|
}
|
|
|
|
|
|
- if ((mc > BFI_MC_MAX) || (mod->mbhdlr[mc].cbfn == NULL))
|
|
|
- return;
|
|
|
+ bfa_ioc_lpu_read_stat(ioc);
|
|
|
|
|
|
- mod->mbhdlr[mc].cbfn(mod->mbhdlr[mc].cbarg, &m);
|
|
|
+ /*
|
|
|
+ * Try to send pending mailbox commands
|
|
|
+ */
|
|
|
+ bfa_ioc_mbox_poll(ioc);
|
|
|
}
|
|
|
|
|
|
void
|
|
|
bfa_ioc_error_isr(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
+ bfa_ioc_stats(ioc, ioc_hbfails);
|
|
|
+ ioc->stats.hb_count = ioc->hb_count;
|
|
|
bfa_fsm_send_event(ioc, IOC_E_HWERROR);
|
|
|
}
|
|
|
|
|
|
-void
|
|
|
-bfa_ioc_set_fcmode(struct bfa_ioc_s *ioc)
|
|
|
-{
|
|
|
- ioc->fcmode = BFA_TRUE;
|
|
|
- ioc->port_id = bfa_ioc_pcifn(ioc);
|
|
|
-}
|
|
|
-
|
|
|
/*
|
|
|
* return true if IOC is disabled
|
|
|
*/
|
|
|
@@ -2212,6 +2410,15 @@ bfa_ioc_is_disabled(struct bfa_ioc_s *ioc)
|
|
|
bfa_fsm_cmp_state(ioc, bfa_ioc_sm_disabled);
|
|
|
}
|
|
|
|
|
|
+/*
|
|
|
+ * Return TRUE if IOC is in acquiring address state
|
|
|
+ */
|
|
|
+bfa_boolean_t
|
|
|
+bfa_ioc_is_acq_addr(struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+ return bfa_fsm_cmp_state(ioc, bfa_ioc_sm_acq_addr);
|
|
|
+}
|
|
|
+
|
|
|
/*
|
|
|
* return true if IOC firmware is different.
|
|
|
*/
|
|
|
@@ -2239,17 +2446,16 @@ bfa_boolean_t
|
|
|
bfa_ioc_adapter_is_disabled(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
u32 ioc_state;
|
|
|
- void __iomem *rb = ioc->pcidev.pci_bar_kva;
|
|
|
|
|
|
if (!bfa_fsm_cmp_state(ioc, bfa_ioc_sm_disabled))
|
|
|
return BFA_FALSE;
|
|
|
|
|
|
- ioc_state = readl(rb + BFA_IOC0_STATE_REG);
|
|
|
+ ioc_state = readl(ioc->ioc_regs.ioc_fwstate);
|
|
|
if (!bfa_ioc_state_disabled(ioc_state))
|
|
|
return BFA_FALSE;
|
|
|
|
|
|
if (ioc->pcidev.device_id != BFA_PCI_DEVICE_ID_FC_8G1P) {
|
|
|
- ioc_state = readl(rb + BFA_IOC1_STATE_REG);
|
|
|
+ ioc_state = readl(ioc->ioc_regs.alt_ioc_fwstate);
|
|
|
if (!bfa_ioc_state_disabled(ioc_state))
|
|
|
return BFA_FALSE;
|
|
|
}
|
|
|
@@ -2308,24 +2514,21 @@ bfa_ioc_get_adapter_attr(struct bfa_ioc_s *ioc,
|
|
|
|
|
|
bfa_ioc_get_pci_chip_rev(ioc, ad_attr->hw_ver);
|
|
|
|
|
|
- ad_attr->cna_capable = ioc->cna;
|
|
|
- ad_attr->trunk_capable = (ad_attr->nports > 1) && !ioc->cna &&
|
|
|
- !ad_attr->is_mezz;
|
|
|
+ ad_attr->cna_capable = bfa_ioc_is_cna(ioc);
|
|
|
+ ad_attr->trunk_capable = (ad_attr->nports > 1) &&
|
|
|
+ !bfa_ioc_is_cna(ioc) && !ad_attr->is_mezz;
|
|
|
}
|
|
|
|
|
|
enum bfa_ioc_type_e
|
|
|
bfa_ioc_get_type(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
- if (!ioc->ctdev || ioc->fcmode)
|
|
|
- return BFA_IOC_TYPE_FC;
|
|
|
- else if (ioc->ioc_mc == BFI_MC_IOCFC)
|
|
|
- return BFA_IOC_TYPE_FCoE;
|
|
|
- else if (ioc->ioc_mc == BFI_MC_LL)
|
|
|
- return BFA_IOC_TYPE_LL;
|
|
|
- else {
|
|
|
- WARN_ON(ioc->ioc_mc != BFI_MC_LL);
|
|
|
+ if (ioc->clscode == BFI_PCIFN_CLASS_ETH)
|
|
|
return BFA_IOC_TYPE_LL;
|
|
|
- }
|
|
|
+
|
|
|
+ WARN_ON(ioc->clscode != BFI_PCIFN_CLASS_FC);
|
|
|
+
|
|
|
+ return (ioc->attr->port_mode == BFI_PORT_MODE_FC)
|
|
|
+ ? BFA_IOC_TYPE_FC : BFA_IOC_TYPE_FCoE;
|
|
|
}
|
|
|
|
|
|
void
|
|
|
@@ -2384,11 +2587,8 @@ bfa_ioc_get_adapter_model(struct bfa_ioc_s *ioc, char *model)
|
|
|
|
|
|
ioc_attr = ioc->attr;
|
|
|
|
|
|
- /*
|
|
|
- * model name
|
|
|
- */
|
|
|
snprintf(model, BFA_ADAPTER_MODEL_NAME_LEN, "%s-%u",
|
|
|
- BFA_MFG_NAME, ioc_attr->card_type);
|
|
|
+ BFA_MFG_NAME, ioc_attr->card_type);
|
|
|
}
|
|
|
|
|
|
enum bfa_ioc_state
|
|
|
@@ -2438,6 +2638,9 @@ bfa_ioc_get_attr(struct bfa_ioc_s *ioc, struct bfa_ioc_attr_s *ioc_attr)
|
|
|
|
|
|
ioc_attr->state = bfa_ioc_get_state(ioc);
|
|
|
ioc_attr->port_id = ioc->port_id;
|
|
|
+ ioc_attr->port_mode = ioc->port_mode;
|
|
|
+ ioc_attr->port_mode_cfg = ioc->port_mode_cfg;
|
|
|
+ ioc_attr->cap_bm = ioc->ad_cap_bm;
|
|
|
|
|
|
ioc_attr->ioc_type = bfa_ioc_get_type(ioc);
|
|
|
|
|
|
@@ -2475,12 +2678,6 @@ bfa_ioc_get_mfg_mac(struct bfa_ioc_s *ioc)
|
|
|
return m;
|
|
|
}
|
|
|
|
|
|
-bfa_boolean_t
|
|
|
-bfa_ioc_get_fcmode(struct bfa_ioc_s *ioc)
|
|
|
-{
|
|
|
- return ioc->fcmode || !bfa_asic_id_ct(ioc->pcidev.device_id);
|
|
|
-}
|
|
|
-
|
|
|
/*
|
|
|
* Retrieve saved firmware trace from a prior IOC failure.
|
|
|
*/
|
|
|
@@ -2531,7 +2728,7 @@ bfa_ioc_send_fwsync(struct bfa_ioc_s *ioc)
|
|
|
|
|
|
bfi_h2i_set(req->mh, BFI_MC_IOC, BFI_IOC_H2I_DBG_SYNC,
|
|
|
bfa_ioc_portid(ioc));
|
|
|
- req->ioc_class = ioc->ioc_mc;
|
|
|
+ req->clscode = cpu_to_be16(ioc->clscode);
|
|
|
bfa_ioc_mbox_queue(ioc, &cmd);
|
|
|
}
|
|
|
|
|
|
@@ -2673,6 +2870,7 @@ static void
|
|
|
bfa_ioc_recover(struct bfa_ioc_s *ioc)
|
|
|
{
|
|
|
bfa_ioc_stats(ioc, ioc_hbfails);
|
|
|
+ ioc->stats.hb_count = ioc->hb_count;
|
|
|
bfa_fsm_send_event(ioc, IOC_E_HBFAIL);
|
|
|
}
|
|
|
|
|
|
@@ -2703,6 +2901,34 @@ bfa_iocpf_sem_timeout(void *ioc_arg)
|
|
|
bfa_ioc_hw_sem_get(ioc);
|
|
|
}
|
|
|
|
|
|
+static void
|
|
|
+bfa_ioc_poll_fwinit(struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+ u32 fwstate = readl(ioc->ioc_regs.ioc_fwstate);
|
|
|
+
|
|
|
+ bfa_trc(ioc, fwstate);
|
|
|
+
|
|
|
+ if (fwstate == BFI_IOC_DISABLED) {
|
|
|
+ bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_FWREADY);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ioc->iocpf.poll_time >= BFA_IOC_TOV)
|
|
|
+ bfa_iocpf_timeout(ioc);
|
|
|
+ else {
|
|
|
+ ioc->iocpf.poll_time += BFA_IOC_POLL_TOV;
|
|
|
+ bfa_iocpf_poll_timer_start(ioc);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_iocpf_poll_timeout(void *ioc_arg)
|
|
|
+{
|
|
|
+ struct bfa_ioc_s *ioc = (struct bfa_ioc_s *) ioc_arg;
|
|
|
+
|
|
|
+ bfa_ioc_poll_fwinit(ioc);
|
|
|
+}
|
|
|
+
|
|
|
/*
|
|
|
* bfa timer function
|
|
|
*/
|
|
|
@@ -2770,3 +2996,2423 @@ bfa_timer_stop(struct bfa_timer_s *timer)
|
|
|
|
|
|
list_del(&timer->qe);
|
|
|
}
|
|
|
+
|
|
|
+/*
|
|
|
+ * ASIC block related
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_ablk_config_swap(struct bfa_ablk_cfg_s *cfg)
|
|
|
+{
|
|
|
+ struct bfa_ablk_cfg_inst_s *cfg_inst;
|
|
|
+ int i, j;
|
|
|
+ u16 be16;
|
|
|
+ u32 be32;
|
|
|
+
|
|
|
+ for (i = 0; i < BFA_ABLK_MAX; i++) {
|
|
|
+ cfg_inst = &cfg->inst[i];
|
|
|
+ for (j = 0; j < BFA_ABLK_MAX_PFS; j++) {
|
|
|
+ be16 = cfg_inst->pf_cfg[j].pers;
|
|
|
+ cfg_inst->pf_cfg[j].pers = be16_to_cpu(be16);
|
|
|
+ be16 = cfg_inst->pf_cfg[j].num_qpairs;
|
|
|
+ cfg_inst->pf_cfg[j].num_qpairs = be16_to_cpu(be16);
|
|
|
+ be16 = cfg_inst->pf_cfg[j].num_vectors;
|
|
|
+ cfg_inst->pf_cfg[j].num_vectors = be16_to_cpu(be16);
|
|
|
+ be32 = cfg_inst->pf_cfg[j].bw;
|
|
|
+ cfg_inst->pf_cfg[j].bw = be16_to_cpu(be32);
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_ablk_isr(void *cbarg, struct bfi_mbmsg_s *msg)
|
|
|
+{
|
|
|
+ struct bfa_ablk_s *ablk = (struct bfa_ablk_s *)cbarg;
|
|
|
+ struct bfi_ablk_i2h_rsp_s *rsp = (struct bfi_ablk_i2h_rsp_s *)msg;
|
|
|
+ bfa_ablk_cbfn_t cbfn;
|
|
|
+
|
|
|
+ WARN_ON(msg->mh.msg_class != BFI_MC_ABLK);
|
|
|
+ bfa_trc(ablk->ioc, msg->mh.msg_id);
|
|
|
+
|
|
|
+ switch (msg->mh.msg_id) {
|
|
|
+ case BFI_ABLK_I2H_QUERY:
|
|
|
+ if (rsp->status == BFA_STATUS_OK) {
|
|
|
+ memcpy(ablk->cfg, ablk->dma_addr.kva,
|
|
|
+ sizeof(struct bfa_ablk_cfg_s));
|
|
|
+ bfa_ablk_config_swap(ablk->cfg);
|
|
|
+ ablk->cfg = NULL;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFI_ABLK_I2H_ADPT_CONFIG:
|
|
|
+ case BFI_ABLK_I2H_PORT_CONFIG:
|
|
|
+ /* update config port mode */
|
|
|
+ ablk->ioc->port_mode_cfg = rsp->port_mode;
|
|
|
+
|
|
|
+ case BFI_ABLK_I2H_PF_DELETE:
|
|
|
+ case BFI_ABLK_I2H_PF_UPDATE:
|
|
|
+ case BFI_ABLK_I2H_OPTROM_ENABLE:
|
|
|
+ case BFI_ABLK_I2H_OPTROM_DISABLE:
|
|
|
+ /* No-op */
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFI_ABLK_I2H_PF_CREATE:
|
|
|
+ *(ablk->pcifn) = rsp->pcifn;
|
|
|
+ ablk->pcifn = NULL;
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->busy = BFA_FALSE;
|
|
|
+ if (ablk->cbfn) {
|
|
|
+ cbfn = ablk->cbfn;
|
|
|
+ ablk->cbfn = NULL;
|
|
|
+ cbfn(ablk->cbarg, rsp->status);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_ablk_notify(void *cbarg, enum bfa_ioc_event_e event)
|
|
|
+{
|
|
|
+ struct bfa_ablk_s *ablk = (struct bfa_ablk_s *)cbarg;
|
|
|
+
|
|
|
+ bfa_trc(ablk->ioc, event);
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case BFA_IOC_E_ENABLED:
|
|
|
+ WARN_ON(ablk->busy != BFA_FALSE);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFA_IOC_E_DISABLED:
|
|
|
+ case BFA_IOC_E_FAILED:
|
|
|
+ /* Fail any pending requests */
|
|
|
+ ablk->pcifn = NULL;
|
|
|
+ if (ablk->busy) {
|
|
|
+ if (ablk->cbfn)
|
|
|
+ ablk->cbfn(ablk->cbarg, BFA_STATUS_FAILED);
|
|
|
+ ablk->cbfn = NULL;
|
|
|
+ ablk->busy = BFA_FALSE;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+u32
|
|
|
+bfa_ablk_meminfo(void)
|
|
|
+{
|
|
|
+ return BFA_ROUNDUP(sizeof(struct bfa_ablk_cfg_s), BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+void
|
|
|
+bfa_ablk_memclaim(struct bfa_ablk_s *ablk, u8 *dma_kva, u64 dma_pa)
|
|
|
+{
|
|
|
+ ablk->dma_addr.kva = dma_kva;
|
|
|
+ ablk->dma_addr.pa = dma_pa;
|
|
|
+}
|
|
|
+
|
|
|
+void
|
|
|
+bfa_ablk_attach(struct bfa_ablk_s *ablk, struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+ ablk->ioc = ioc;
|
|
|
+
|
|
|
+ bfa_ioc_mbox_regisr(ablk->ioc, BFI_MC_ABLK, bfa_ablk_isr, ablk);
|
|
|
+ bfa_q_qe_init(&ablk->ioc_notify);
|
|
|
+ bfa_ioc_notify_init(&ablk->ioc_notify, bfa_ablk_notify, ablk);
|
|
|
+ list_add_tail(&ablk->ioc_notify.qe, &ablk->ioc->notify_q);
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_query(struct bfa_ablk_s *ablk, struct bfa_ablk_cfg_s *ablk_cfg,
|
|
|
+ bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_query_s *m;
|
|
|
+
|
|
|
+ WARN_ON(!ablk_cfg);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cfg = ablk_cfg;
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_query_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_QUERY,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ bfa_dma_be_addr_set(m->addr, ablk->dma_addr.pa);
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_pf_create(struct bfa_ablk_s *ablk, u16 *pcifn,
|
|
|
+ u8 port, enum bfi_pcifn_class personality, int bw,
|
|
|
+ bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_pf_req_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->pcifn = pcifn;
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_pf_req_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_PF_CREATE,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ m->pers = cpu_to_be16((u16)personality);
|
|
|
+ m->bw = cpu_to_be32(bw);
|
|
|
+ m->port = port;
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_pf_delete(struct bfa_ablk_s *ablk, int pcifn,
|
|
|
+ bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_pf_req_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_pf_req_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_PF_DELETE,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ m->pcifn = (u8)pcifn;
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_adapter_config(struct bfa_ablk_s *ablk, enum bfa_mode_s mode,
|
|
|
+ int max_pf, int max_vf, bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_cfg_req_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_cfg_req_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_ADPT_CONFIG,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ m->mode = (u8)mode;
|
|
|
+ m->max_pf = (u8)max_pf;
|
|
|
+ m->max_vf = (u8)max_vf;
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_port_config(struct bfa_ablk_s *ablk, int port, enum bfa_mode_s mode,
|
|
|
+ int max_pf, int max_vf, bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_cfg_req_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_cfg_req_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_PORT_CONFIG,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ m->port = (u8)port;
|
|
|
+ m->mode = (u8)mode;
|
|
|
+ m->max_pf = (u8)max_pf;
|
|
|
+ m->max_vf = (u8)max_vf;
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_pf_update(struct bfa_ablk_s *ablk, int pcifn, int bw,
|
|
|
+ bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_pf_req_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_pf_req_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_PF_UPDATE,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ m->pcifn = (u8)pcifn;
|
|
|
+ m->bw = cpu_to_be32(bw);
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_optrom_en(struct bfa_ablk_s *ablk, bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_optrom_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_optrom_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_OPTROM_ENABLE,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+bfa_status_t
|
|
|
+bfa_ablk_optrom_dis(struct bfa_ablk_s *ablk, bfa_ablk_cbfn_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ struct bfi_ablk_h2i_optrom_s *m;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(ablk->ioc)) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_IOC_FAILURE);
|
|
|
+ return BFA_STATUS_IOC_FAILURE;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ablk->busy) {
|
|
|
+ bfa_trc(ablk->ioc, BFA_STATUS_DEVBUSY);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ ablk->cbfn = cbfn;
|
|
|
+ ablk->cbarg = cbarg;
|
|
|
+ ablk->busy = BFA_TRUE;
|
|
|
+
|
|
|
+ m = (struct bfi_ablk_h2i_optrom_s *)ablk->mb.msg;
|
|
|
+ bfi_h2i_set(m->mh, BFI_MC_ABLK, BFI_ABLK_H2I_OPTROM_DISABLE,
|
|
|
+ bfa_ioc_portid(ablk->ioc));
|
|
|
+ bfa_ioc_mbox_queue(ablk->ioc, &ablk->mb);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * SFP module specific
|
|
|
+ */
|
|
|
+
|
|
|
+/* forward declarations */
|
|
|
+static void bfa_sfp_getdata_send(struct bfa_sfp_s *sfp);
|
|
|
+static void bfa_sfp_media_get(struct bfa_sfp_s *sfp);
|
|
|
+static bfa_status_t bfa_sfp_speed_valid(struct bfa_sfp_s *sfp,
|
|
|
+ enum bfa_port_speed portspeed);
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_cb_sfp_show(struct bfa_sfp_s *sfp)
|
|
|
+{
|
|
|
+ bfa_trc(sfp, sfp->lock);
|
|
|
+ if (sfp->cbfn)
|
|
|
+ sfp->cbfn(sfp->cbarg, sfp->status);
|
|
|
+ sfp->lock = 0;
|
|
|
+ sfp->cbfn = NULL;
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_cb_sfp_state_query(struct bfa_sfp_s *sfp)
|
|
|
+{
|
|
|
+ bfa_trc(sfp, sfp->portspeed);
|
|
|
+ if (sfp->media) {
|
|
|
+ bfa_sfp_media_get(sfp);
|
|
|
+ if (sfp->state_query_cbfn)
|
|
|
+ sfp->state_query_cbfn(sfp->state_query_cbarg,
|
|
|
+ sfp->status);
|
|
|
+ sfp->media = NULL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (sfp->portspeed) {
|
|
|
+ sfp->status = bfa_sfp_speed_valid(sfp, sfp->portspeed);
|
|
|
+ if (sfp->state_query_cbfn)
|
|
|
+ sfp->state_query_cbfn(sfp->state_query_cbarg,
|
|
|
+ sfp->status);
|
|
|
+ sfp->portspeed = BFA_PORT_SPEED_UNKNOWN;
|
|
|
+ }
|
|
|
+
|
|
|
+ sfp->state_query_lock = 0;
|
|
|
+ sfp->state_query_cbfn = NULL;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * IOC event handler.
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_sfp_notify(void *sfp_arg, enum bfa_ioc_event_e event)
|
|
|
+{
|
|
|
+ struct bfa_sfp_s *sfp = sfp_arg;
|
|
|
+
|
|
|
+ bfa_trc(sfp, event);
|
|
|
+ bfa_trc(sfp, sfp->lock);
|
|
|
+ bfa_trc(sfp, sfp->state_query_lock);
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case BFA_IOC_E_DISABLED:
|
|
|
+ case BFA_IOC_E_FAILED:
|
|
|
+ if (sfp->lock) {
|
|
|
+ sfp->status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ bfa_cb_sfp_show(sfp);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (sfp->state_query_lock) {
|
|
|
+ sfp->status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ bfa_cb_sfp_state_query(sfp);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * SFP get data send
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_sfp_getdata_send(struct bfa_sfp_s *sfp)
|
|
|
+{
|
|
|
+ struct bfi_sfp_req_s *req = (struct bfi_sfp_req_s *)sfp->mbcmd.msg;
|
|
|
+
|
|
|
+ bfa_trc(sfp, req->memtype);
|
|
|
+
|
|
|
+ /* build host command */
|
|
|
+ bfi_h2i_set(req->mh, BFI_MC_SFP, BFI_SFP_H2I_SHOW,
|
|
|
+ bfa_ioc_portid(sfp->ioc));
|
|
|
+
|
|
|
+ /* send mbox cmd */
|
|
|
+ bfa_ioc_mbox_queue(sfp->ioc, &sfp->mbcmd);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * SFP is valid, read sfp data
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_sfp_getdata(struct bfa_sfp_s *sfp, enum bfi_sfp_mem_e memtype)
|
|
|
+{
|
|
|
+ struct bfi_sfp_req_s *req = (struct bfi_sfp_req_s *)sfp->mbcmd.msg;
|
|
|
+
|
|
|
+ WARN_ON(sfp->lock != 0);
|
|
|
+ bfa_trc(sfp, sfp->state);
|
|
|
+
|
|
|
+ sfp->lock = 1;
|
|
|
+ sfp->memtype = memtype;
|
|
|
+ req->memtype = memtype;
|
|
|
+
|
|
|
+ /* Setup SG list */
|
|
|
+ bfa_alen_set(&req->alen, sizeof(struct sfp_mem_s), sfp->dbuf_pa);
|
|
|
+
|
|
|
+ bfa_sfp_getdata_send(sfp);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * SFP show complete
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_sfp_show_comp(struct bfa_sfp_s *sfp, struct bfi_mbmsg_s *msg)
|
|
|
+{
|
|
|
+ struct bfi_sfp_rsp_s *rsp = (struct bfi_sfp_rsp_s *) msg;
|
|
|
+
|
|
|
+ if (!sfp->lock) {
|
|
|
+ /*
|
|
|
+ * receiving response after ioc failure
|
|
|
+ */
|
|
|
+ bfa_trc(sfp, sfp->lock);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ bfa_trc(sfp, rsp->status);
|
|
|
+ if (rsp->status == BFA_STATUS_OK) {
|
|
|
+ sfp->data_valid = 1;
|
|
|
+ if (sfp->state == BFA_SFP_STATE_VALID)
|
|
|
+ sfp->status = BFA_STATUS_OK;
|
|
|
+ else if (sfp->state == BFA_SFP_STATE_UNSUPPORT)
|
|
|
+ sfp->status = BFA_STATUS_SFP_UNSUPP;
|
|
|
+ else
|
|
|
+ bfa_trc(sfp, sfp->state);
|
|
|
+ } else {
|
|
|
+ sfp->data_valid = 0;
|
|
|
+ sfp->status = rsp->status;
|
|
|
+ /* sfpshow shouldn't change sfp state */
|
|
|
+ }
|
|
|
+
|
|
|
+ bfa_trc(sfp, sfp->memtype);
|
|
|
+ if (sfp->memtype == BFI_SFP_MEM_DIAGEXT) {
|
|
|
+ bfa_trc(sfp, sfp->data_valid);
|
|
|
+ if (sfp->data_valid) {
|
|
|
+ u32 size = sizeof(struct sfp_mem_s);
|
|
|
+ u8 *des = (u8 *) &(sfp->sfpmem->srlid_base);
|
|
|
+ memcpy(des, sfp->dbuf_kva, size);
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ * Queue completion callback.
|
|
|
+ */
|
|
|
+ bfa_cb_sfp_show(sfp);
|
|
|
+ } else
|
|
|
+ sfp->lock = 0;
|
|
|
+
|
|
|
+ bfa_trc(sfp, sfp->state_query_lock);
|
|
|
+ if (sfp->state_query_lock) {
|
|
|
+ sfp->state = rsp->state;
|
|
|
+ /* Complete callback */
|
|
|
+ bfa_cb_sfp_state_query(sfp);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * SFP query fw sfp state
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_sfp_state_query(struct bfa_sfp_s *sfp)
|
|
|
+{
|
|
|
+ struct bfi_sfp_req_s *req = (struct bfi_sfp_req_s *)sfp->mbcmd.msg;
|
|
|
+
|
|
|
+ /* Should not be doing query if not in _INIT state */
|
|
|
+ WARN_ON(sfp->state != BFA_SFP_STATE_INIT);
|
|
|
+ WARN_ON(sfp->state_query_lock != 0);
|
|
|
+ bfa_trc(sfp, sfp->state);
|
|
|
+
|
|
|
+ sfp->state_query_lock = 1;
|
|
|
+ req->memtype = 0;
|
|
|
+
|
|
|
+ if (!sfp->lock)
|
|
|
+ bfa_sfp_getdata(sfp, BFI_SFP_MEM_ALL);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_sfp_media_get(struct bfa_sfp_s *sfp)
|
|
|
+{
|
|
|
+ enum bfa_defs_sfp_media_e *media = sfp->media;
|
|
|
+
|
|
|
+ *media = BFA_SFP_MEDIA_UNKNOWN;
|
|
|
+
|
|
|
+ if (sfp->state == BFA_SFP_STATE_UNSUPPORT)
|
|
|
+ *media = BFA_SFP_MEDIA_UNSUPPORT;
|
|
|
+ else if (sfp->state == BFA_SFP_STATE_VALID) {
|
|
|
+ union sfp_xcvr_e10g_code_u e10g;
|
|
|
+ struct sfp_mem_s *sfpmem = (struct sfp_mem_s *)sfp->dbuf_kva;
|
|
|
+ u16 xmtr_tech = (sfpmem->srlid_base.xcvr[4] & 0x3) << 7 |
|
|
|
+ (sfpmem->srlid_base.xcvr[5] >> 1);
|
|
|
+
|
|
|
+ e10g.b = sfpmem->srlid_base.xcvr[0];
|
|
|
+ bfa_trc(sfp, e10g.b);
|
|
|
+ bfa_trc(sfp, xmtr_tech);
|
|
|
+ /* check fc transmitter tech */
|
|
|
+ if ((xmtr_tech & SFP_XMTR_TECH_CU) ||
|
|
|
+ (xmtr_tech & SFP_XMTR_TECH_CP) ||
|
|
|
+ (xmtr_tech & SFP_XMTR_TECH_CA))
|
|
|
+ *media = BFA_SFP_MEDIA_CU;
|
|
|
+ else if ((xmtr_tech & SFP_XMTR_TECH_EL_INTRA) ||
|
|
|
+ (xmtr_tech & SFP_XMTR_TECH_EL_INTER))
|
|
|
+ *media = BFA_SFP_MEDIA_EL;
|
|
|
+ else if ((xmtr_tech & SFP_XMTR_TECH_LL) ||
|
|
|
+ (xmtr_tech & SFP_XMTR_TECH_LC))
|
|
|
+ *media = BFA_SFP_MEDIA_LW;
|
|
|
+ else if ((xmtr_tech & SFP_XMTR_TECH_SL) ||
|
|
|
+ (xmtr_tech & SFP_XMTR_TECH_SN) ||
|
|
|
+ (xmtr_tech & SFP_XMTR_TECH_SA))
|
|
|
+ *media = BFA_SFP_MEDIA_SW;
|
|
|
+ /* Check 10G Ethernet Compilance code */
|
|
|
+ else if (e10g.b & 0x10)
|
|
|
+ *media = BFA_SFP_MEDIA_SW;
|
|
|
+ else if (e10g.b & 0x60)
|
|
|
+ *media = BFA_SFP_MEDIA_LW;
|
|
|
+ else if (e10g.r.e10g_unall & 0x80)
|
|
|
+ *media = BFA_SFP_MEDIA_UNKNOWN;
|
|
|
+ else
|
|
|
+ bfa_trc(sfp, 0);
|
|
|
+ } else
|
|
|
+ bfa_trc(sfp, sfp->state);
|
|
|
+}
|
|
|
+
|
|
|
+static bfa_status_t
|
|
|
+bfa_sfp_speed_valid(struct bfa_sfp_s *sfp, enum bfa_port_speed portspeed)
|
|
|
+{
|
|
|
+ struct sfp_mem_s *sfpmem = (struct sfp_mem_s *)sfp->dbuf_kva;
|
|
|
+ struct sfp_xcvr_s *xcvr = (struct sfp_xcvr_s *) sfpmem->srlid_base.xcvr;
|
|
|
+ union sfp_xcvr_fc3_code_u fc3 = xcvr->fc3;
|
|
|
+ union sfp_xcvr_e10g_code_u e10g = xcvr->e10g;
|
|
|
+
|
|
|
+ if (portspeed == BFA_PORT_SPEED_10GBPS) {
|
|
|
+ if (e10g.r.e10g_sr || e10g.r.e10g_lr)
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+ else {
|
|
|
+ bfa_trc(sfp, e10g.b);
|
|
|
+ return BFA_STATUS_UNSUPP_SPEED;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ if (((portspeed & BFA_PORT_SPEED_16GBPS) && fc3.r.mb1600) ||
|
|
|
+ ((portspeed & BFA_PORT_SPEED_8GBPS) && fc3.r.mb800) ||
|
|
|
+ ((portspeed & BFA_PORT_SPEED_4GBPS) && fc3.r.mb400) ||
|
|
|
+ ((portspeed & BFA_PORT_SPEED_2GBPS) && fc3.r.mb200) ||
|
|
|
+ ((portspeed & BFA_PORT_SPEED_1GBPS) && fc3.r.mb100))
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+ else {
|
|
|
+ bfa_trc(sfp, portspeed);
|
|
|
+ bfa_trc(sfp, fc3.b);
|
|
|
+ bfa_trc(sfp, e10g.b);
|
|
|
+ return BFA_STATUS_UNSUPP_SPEED;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * SFP hmbox handler
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_sfp_intr(void *sfparg, struct bfi_mbmsg_s *msg)
|
|
|
+{
|
|
|
+ struct bfa_sfp_s *sfp = sfparg;
|
|
|
+
|
|
|
+ switch (msg->mh.msg_id) {
|
|
|
+ case BFI_SFP_I2H_SHOW:
|
|
|
+ bfa_sfp_show_comp(sfp, msg);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case BFI_SFP_I2H_SCN:
|
|
|
+ bfa_trc(sfp, msg->mh.msg_id);
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ bfa_trc(sfp, msg->mh.msg_id);
|
|
|
+ WARN_ON(1);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Return DMA memory needed by sfp module.
|
|
|
+ */
|
|
|
+u32
|
|
|
+bfa_sfp_meminfo(void)
|
|
|
+{
|
|
|
+ return BFA_ROUNDUP(sizeof(struct sfp_mem_s), BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Attach virtual and physical memory for SFP.
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_sfp_attach(struct bfa_sfp_s *sfp, struct bfa_ioc_s *ioc, void *dev,
|
|
|
+ struct bfa_trc_mod_s *trcmod)
|
|
|
+{
|
|
|
+ sfp->dev = dev;
|
|
|
+ sfp->ioc = ioc;
|
|
|
+ sfp->trcmod = trcmod;
|
|
|
+
|
|
|
+ sfp->cbfn = NULL;
|
|
|
+ sfp->cbarg = NULL;
|
|
|
+ sfp->sfpmem = NULL;
|
|
|
+ sfp->lock = 0;
|
|
|
+ sfp->data_valid = 0;
|
|
|
+ sfp->state = BFA_SFP_STATE_INIT;
|
|
|
+ sfp->state_query_lock = 0;
|
|
|
+ sfp->state_query_cbfn = NULL;
|
|
|
+ sfp->state_query_cbarg = NULL;
|
|
|
+ sfp->media = NULL;
|
|
|
+ sfp->portspeed = BFA_PORT_SPEED_UNKNOWN;
|
|
|
+ sfp->is_elb = BFA_FALSE;
|
|
|
+
|
|
|
+ bfa_ioc_mbox_regisr(sfp->ioc, BFI_MC_SFP, bfa_sfp_intr, sfp);
|
|
|
+ bfa_q_qe_init(&sfp->ioc_notify);
|
|
|
+ bfa_ioc_notify_init(&sfp->ioc_notify, bfa_sfp_notify, sfp);
|
|
|
+ list_add_tail(&sfp->ioc_notify.qe, &sfp->ioc->notify_q);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Claim Memory for SFP
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_sfp_memclaim(struct bfa_sfp_s *sfp, u8 *dm_kva, u64 dm_pa)
|
|
|
+{
|
|
|
+ sfp->dbuf_kva = dm_kva;
|
|
|
+ sfp->dbuf_pa = dm_pa;
|
|
|
+ memset(sfp->dbuf_kva, 0, sizeof(struct sfp_mem_s));
|
|
|
+
|
|
|
+ dm_kva += BFA_ROUNDUP(sizeof(struct sfp_mem_s), BFA_DMA_ALIGN_SZ);
|
|
|
+ dm_pa += BFA_ROUNDUP(sizeof(struct sfp_mem_s), BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Show SFP eeprom content
|
|
|
+ *
|
|
|
+ * @param[in] sfp - bfa sfp module
|
|
|
+ *
|
|
|
+ * @param[out] sfpmem - sfp eeprom data
|
|
|
+ *
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_sfp_show(struct bfa_sfp_s *sfp, struct sfp_mem_s *sfpmem,
|
|
|
+ bfa_cb_sfp_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(sfp->ioc)) {
|
|
|
+ bfa_trc(sfp, 0);
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (sfp->lock) {
|
|
|
+ bfa_trc(sfp, 0);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ sfp->cbfn = cbfn;
|
|
|
+ sfp->cbarg = cbarg;
|
|
|
+ sfp->sfpmem = sfpmem;
|
|
|
+
|
|
|
+ bfa_sfp_getdata(sfp, BFI_SFP_MEM_DIAGEXT);
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Return SFP Media type
|
|
|
+ *
|
|
|
+ * @param[in] sfp - bfa sfp module
|
|
|
+ *
|
|
|
+ * @param[out] media - port speed from user
|
|
|
+ *
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_sfp_media(struct bfa_sfp_s *sfp, enum bfa_defs_sfp_media_e *media,
|
|
|
+ bfa_cb_sfp_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ if (!bfa_ioc_is_operational(sfp->ioc)) {
|
|
|
+ bfa_trc(sfp, 0);
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+ }
|
|
|
+
|
|
|
+ sfp->media = media;
|
|
|
+ if (sfp->state == BFA_SFP_STATE_INIT) {
|
|
|
+ if (sfp->state_query_lock) {
|
|
|
+ bfa_trc(sfp, 0);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ } else {
|
|
|
+ sfp->state_query_cbfn = cbfn;
|
|
|
+ sfp->state_query_cbarg = cbarg;
|
|
|
+ bfa_sfp_state_query(sfp);
|
|
|
+ return BFA_STATUS_SFP_NOT_READY;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ bfa_sfp_media_get(sfp);
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Check if user set port speed is allowed by the SFP
|
|
|
+ *
|
|
|
+ * @param[in] sfp - bfa sfp module
|
|
|
+ * @param[in] portspeed - port speed from user
|
|
|
+ *
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_sfp_speed(struct bfa_sfp_s *sfp, enum bfa_port_speed portspeed,
|
|
|
+ bfa_cb_sfp_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ WARN_ON(portspeed == BFA_PORT_SPEED_UNKNOWN);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(sfp->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ /* For Mezz card, all speed is allowed */
|
|
|
+ if (bfa_mfg_is_mezz(sfp->ioc->attr->card_type))
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+
|
|
|
+ /* Check SFP state */
|
|
|
+ sfp->portspeed = portspeed;
|
|
|
+ if (sfp->state == BFA_SFP_STATE_INIT) {
|
|
|
+ if (sfp->state_query_lock) {
|
|
|
+ bfa_trc(sfp, 0);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ } else {
|
|
|
+ sfp->state_query_cbfn = cbfn;
|
|
|
+ sfp->state_query_cbarg = cbarg;
|
|
|
+ bfa_sfp_state_query(sfp);
|
|
|
+ return BFA_STATUS_SFP_NOT_READY;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (sfp->state == BFA_SFP_STATE_REMOVED ||
|
|
|
+ sfp->state == BFA_SFP_STATE_FAILED) {
|
|
|
+ bfa_trc(sfp, sfp->state);
|
|
|
+ return BFA_STATUS_NO_SFP_DEV;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (sfp->state == BFA_SFP_STATE_INSERTED) {
|
|
|
+ bfa_trc(sfp, sfp->state);
|
|
|
+ return BFA_STATUS_DEVBUSY; /* sfp is reading data */
|
|
|
+ }
|
|
|
+
|
|
|
+ /* For eloopback, all speed is allowed */
|
|
|
+ if (sfp->is_elb)
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+
|
|
|
+ return bfa_sfp_speed_valid(sfp, portspeed);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Flash module specific
|
|
|
+ */
|
|
|
+
|
|
|
+/*
|
|
|
+ * FLASH DMA buffer should be big enough to hold both MFG block and
|
|
|
+ * asic block(64k) at the same time and also should be 2k aligned to
|
|
|
+ * avoid write segement to cross sector boundary.
|
|
|
+ */
|
|
|
+#define BFA_FLASH_SEG_SZ 2048
|
|
|
+#define BFA_FLASH_DMA_BUF_SZ \
|
|
|
+ BFA_ROUNDUP(0x010000 + sizeof(struct bfa_mfg_block_s), BFA_FLASH_SEG_SZ)
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_flash_cb(struct bfa_flash_s *flash)
|
|
|
+{
|
|
|
+ flash->op_busy = 0;
|
|
|
+ if (flash->cbfn)
|
|
|
+ flash->cbfn(flash->cbarg, flash->status);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_flash_notify(void *cbarg, enum bfa_ioc_event_e event)
|
|
|
+{
|
|
|
+ struct bfa_flash_s *flash = cbarg;
|
|
|
+
|
|
|
+ bfa_trc(flash, event);
|
|
|
+ switch (event) {
|
|
|
+ case BFA_IOC_E_DISABLED:
|
|
|
+ case BFA_IOC_E_FAILED:
|
|
|
+ if (flash->op_busy) {
|
|
|
+ flash->status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ flash->cbfn(flash->cbarg, flash->status);
|
|
|
+ flash->op_busy = 0;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send flash attribute query request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_flash_query_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_flash_s *flash = cbarg;
|
|
|
+ struct bfi_flash_query_req_s *msg =
|
|
|
+ (struct bfi_flash_query_req_s *) flash->mb.msg;
|
|
|
+
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_FLASH, BFI_FLASH_H2I_QUERY_REQ,
|
|
|
+ bfa_ioc_portid(flash->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, sizeof(struct bfa_flash_attr_s),
|
|
|
+ flash->dbuf_pa);
|
|
|
+ bfa_ioc_mbox_queue(flash->ioc, &flash->mb);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send flash write request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_flash_write_send(struct bfa_flash_s *flash)
|
|
|
+{
|
|
|
+ struct bfi_flash_write_req_s *msg =
|
|
|
+ (struct bfi_flash_write_req_s *) flash->mb.msg;
|
|
|
+ u32 len;
|
|
|
+
|
|
|
+ msg->type = be32_to_cpu(flash->type);
|
|
|
+ msg->instance = flash->instance;
|
|
|
+ msg->offset = be32_to_cpu(flash->addr_off + flash->offset);
|
|
|
+ len = (flash->residue < BFA_FLASH_DMA_BUF_SZ) ?
|
|
|
+ flash->residue : BFA_FLASH_DMA_BUF_SZ;
|
|
|
+ msg->length = be32_to_cpu(len);
|
|
|
+
|
|
|
+ /* indicate if it's the last msg of the whole write operation */
|
|
|
+ msg->last = (len == flash->residue) ? 1 : 0;
|
|
|
+
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_FLASH, BFI_FLASH_H2I_WRITE_REQ,
|
|
|
+ bfa_ioc_portid(flash->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, len, flash->dbuf_pa);
|
|
|
+ memcpy(flash->dbuf_kva, flash->ubuf + flash->offset, len);
|
|
|
+ bfa_ioc_mbox_queue(flash->ioc, &flash->mb);
|
|
|
+
|
|
|
+ flash->residue -= len;
|
|
|
+ flash->offset += len;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send flash read request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_flash_read_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_flash_s *flash = cbarg;
|
|
|
+ struct bfi_flash_read_req_s *msg =
|
|
|
+ (struct bfi_flash_read_req_s *) flash->mb.msg;
|
|
|
+ u32 len;
|
|
|
+
|
|
|
+ msg->type = be32_to_cpu(flash->type);
|
|
|
+ msg->instance = flash->instance;
|
|
|
+ msg->offset = be32_to_cpu(flash->addr_off + flash->offset);
|
|
|
+ len = (flash->residue < BFA_FLASH_DMA_BUF_SZ) ?
|
|
|
+ flash->residue : BFA_FLASH_DMA_BUF_SZ;
|
|
|
+ msg->length = be32_to_cpu(len);
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_FLASH, BFI_FLASH_H2I_READ_REQ,
|
|
|
+ bfa_ioc_portid(flash->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, len, flash->dbuf_pa);
|
|
|
+ bfa_ioc_mbox_queue(flash->ioc, &flash->mb);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send flash erase request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_flash_erase_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_flash_s *flash = cbarg;
|
|
|
+ struct bfi_flash_erase_req_s *msg =
|
|
|
+ (struct bfi_flash_erase_req_s *) flash->mb.msg;
|
|
|
+
|
|
|
+ msg->type = be32_to_cpu(flash->type);
|
|
|
+ msg->instance = flash->instance;
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_FLASH, BFI_FLASH_H2I_ERASE_REQ,
|
|
|
+ bfa_ioc_portid(flash->ioc));
|
|
|
+ bfa_ioc_mbox_queue(flash->ioc, &flash->mb);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Process flash response messages upon receiving interrupts.
|
|
|
+ *
|
|
|
+ * @param[in] flasharg - flash structure
|
|
|
+ * @param[in] msg - message structure
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_flash_intr(void *flasharg, struct bfi_mbmsg_s *msg)
|
|
|
+{
|
|
|
+ struct bfa_flash_s *flash = flasharg;
|
|
|
+ u32 status;
|
|
|
+
|
|
|
+ union {
|
|
|
+ struct bfi_flash_query_rsp_s *query;
|
|
|
+ struct bfi_flash_erase_rsp_s *erase;
|
|
|
+ struct bfi_flash_write_rsp_s *write;
|
|
|
+ struct bfi_flash_read_rsp_s *read;
|
|
|
+ struct bfi_mbmsg_s *msg;
|
|
|
+ } m;
|
|
|
+
|
|
|
+ m.msg = msg;
|
|
|
+ bfa_trc(flash, msg->mh.msg_id);
|
|
|
+
|
|
|
+ if (!flash->op_busy && msg->mh.msg_id != BFI_FLASH_I2H_EVENT) {
|
|
|
+ /* receiving response after ioc failure */
|
|
|
+ bfa_trc(flash, 0x9999);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ switch (msg->mh.msg_id) {
|
|
|
+ case BFI_FLASH_I2H_QUERY_RSP:
|
|
|
+ status = be32_to_cpu(m.query->status);
|
|
|
+ bfa_trc(flash, status);
|
|
|
+ if (status == BFA_STATUS_OK) {
|
|
|
+ u32 i;
|
|
|
+ struct bfa_flash_attr_s *attr, *f;
|
|
|
+
|
|
|
+ attr = (struct bfa_flash_attr_s *) flash->ubuf;
|
|
|
+ f = (struct bfa_flash_attr_s *) flash->dbuf_kva;
|
|
|
+ attr->status = be32_to_cpu(f->status);
|
|
|
+ attr->npart = be32_to_cpu(f->npart);
|
|
|
+ bfa_trc(flash, attr->status);
|
|
|
+ bfa_trc(flash, attr->npart);
|
|
|
+ for (i = 0; i < attr->npart; i++) {
|
|
|
+ attr->part[i].part_type =
|
|
|
+ be32_to_cpu(f->part[i].part_type);
|
|
|
+ attr->part[i].part_instance =
|
|
|
+ be32_to_cpu(f->part[i].part_instance);
|
|
|
+ attr->part[i].part_off =
|
|
|
+ be32_to_cpu(f->part[i].part_off);
|
|
|
+ attr->part[i].part_size =
|
|
|
+ be32_to_cpu(f->part[i].part_size);
|
|
|
+ attr->part[i].part_len =
|
|
|
+ be32_to_cpu(f->part[i].part_len);
|
|
|
+ attr->part[i].part_status =
|
|
|
+ be32_to_cpu(f->part[i].part_status);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ flash->status = status;
|
|
|
+ bfa_flash_cb(flash);
|
|
|
+ break;
|
|
|
+ case BFI_FLASH_I2H_ERASE_RSP:
|
|
|
+ status = be32_to_cpu(m.erase->status);
|
|
|
+ bfa_trc(flash, status);
|
|
|
+ flash->status = status;
|
|
|
+ bfa_flash_cb(flash);
|
|
|
+ break;
|
|
|
+ case BFI_FLASH_I2H_WRITE_RSP:
|
|
|
+ status = be32_to_cpu(m.write->status);
|
|
|
+ bfa_trc(flash, status);
|
|
|
+ if (status != BFA_STATUS_OK || flash->residue == 0) {
|
|
|
+ flash->status = status;
|
|
|
+ bfa_flash_cb(flash);
|
|
|
+ } else {
|
|
|
+ bfa_trc(flash, flash->offset);
|
|
|
+ bfa_flash_write_send(flash);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case BFI_FLASH_I2H_READ_RSP:
|
|
|
+ status = be32_to_cpu(m.read->status);
|
|
|
+ bfa_trc(flash, status);
|
|
|
+ if (status != BFA_STATUS_OK) {
|
|
|
+ flash->status = status;
|
|
|
+ bfa_flash_cb(flash);
|
|
|
+ } else {
|
|
|
+ u32 len = be32_to_cpu(m.read->length);
|
|
|
+ bfa_trc(flash, flash->offset);
|
|
|
+ bfa_trc(flash, len);
|
|
|
+ memcpy(flash->ubuf + flash->offset,
|
|
|
+ flash->dbuf_kva, len);
|
|
|
+ flash->residue -= len;
|
|
|
+ flash->offset += len;
|
|
|
+ if (flash->residue == 0) {
|
|
|
+ flash->status = status;
|
|
|
+ bfa_flash_cb(flash);
|
|
|
+ } else
|
|
|
+ bfa_flash_read_send(flash);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case BFI_FLASH_I2H_BOOT_VER_RSP:
|
|
|
+ case BFI_FLASH_I2H_EVENT:
|
|
|
+ bfa_trc(flash, msg->mh.msg_id);
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Flash memory info API.
|
|
|
+ *
|
|
|
+ * @param[in] mincfg - minimal cfg variable
|
|
|
+ */
|
|
|
+u32
|
|
|
+bfa_flash_meminfo(bfa_boolean_t mincfg)
|
|
|
+{
|
|
|
+ /* min driver doesn't need flash */
|
|
|
+ if (mincfg)
|
|
|
+ return 0;
|
|
|
+ return BFA_ROUNDUP(BFA_FLASH_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Flash attach API.
|
|
|
+ *
|
|
|
+ * @param[in] flash - flash structure
|
|
|
+ * @param[in] ioc - ioc structure
|
|
|
+ * @param[in] dev - device structure
|
|
|
+ * @param[in] trcmod - trace module
|
|
|
+ * @param[in] logmod - log module
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_flash_attach(struct bfa_flash_s *flash, struct bfa_ioc_s *ioc, void *dev,
|
|
|
+ struct bfa_trc_mod_s *trcmod, bfa_boolean_t mincfg)
|
|
|
+{
|
|
|
+ flash->ioc = ioc;
|
|
|
+ flash->trcmod = trcmod;
|
|
|
+ flash->cbfn = NULL;
|
|
|
+ flash->cbarg = NULL;
|
|
|
+ flash->op_busy = 0;
|
|
|
+
|
|
|
+ bfa_ioc_mbox_regisr(flash->ioc, BFI_MC_FLASH, bfa_flash_intr, flash);
|
|
|
+ bfa_q_qe_init(&flash->ioc_notify);
|
|
|
+ bfa_ioc_notify_init(&flash->ioc_notify, bfa_flash_notify, flash);
|
|
|
+ list_add_tail(&flash->ioc_notify.qe, &flash->ioc->notify_q);
|
|
|
+
|
|
|
+ /* min driver doesn't need flash */
|
|
|
+ if (mincfg) {
|
|
|
+ flash->dbuf_kva = NULL;
|
|
|
+ flash->dbuf_pa = 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Claim memory for flash
|
|
|
+ *
|
|
|
+ * @param[in] flash - flash structure
|
|
|
+ * @param[in] dm_kva - pointer to virtual memory address
|
|
|
+ * @param[in] dm_pa - physical memory address
|
|
|
+ * @param[in] mincfg - minimal cfg variable
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_flash_memclaim(struct bfa_flash_s *flash, u8 *dm_kva, u64 dm_pa,
|
|
|
+ bfa_boolean_t mincfg)
|
|
|
+{
|
|
|
+ if (mincfg)
|
|
|
+ return;
|
|
|
+
|
|
|
+ flash->dbuf_kva = dm_kva;
|
|
|
+ flash->dbuf_pa = dm_pa;
|
|
|
+ memset(flash->dbuf_kva, 0, BFA_FLASH_DMA_BUF_SZ);
|
|
|
+ dm_kva += BFA_ROUNDUP(BFA_FLASH_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+ dm_pa += BFA_ROUNDUP(BFA_FLASH_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Get flash attribute.
|
|
|
+ *
|
|
|
+ * @param[in] flash - flash structure
|
|
|
+ * @param[in] attr - flash attribute structure
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_flash_get_attr(struct bfa_flash_s *flash, struct bfa_flash_attr_s *attr,
|
|
|
+ bfa_cb_flash_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(flash, BFI_FLASH_H2I_QUERY_REQ);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(flash->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (flash->op_busy) {
|
|
|
+ bfa_trc(flash, flash->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ flash->op_busy = 1;
|
|
|
+ flash->cbfn = cbfn;
|
|
|
+ flash->cbarg = cbarg;
|
|
|
+ flash->ubuf = (u8 *) attr;
|
|
|
+ bfa_flash_query_send(flash);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Erase flash partition.
|
|
|
+ *
|
|
|
+ * @param[in] flash - flash structure
|
|
|
+ * @param[in] type - flash partition type
|
|
|
+ * @param[in] instance - flash partition instance
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_flash_erase_part(struct bfa_flash_s *flash, enum bfa_flash_part_type type,
|
|
|
+ u8 instance, bfa_cb_flash_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(flash, BFI_FLASH_H2I_ERASE_REQ);
|
|
|
+ bfa_trc(flash, type);
|
|
|
+ bfa_trc(flash, instance);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(flash->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (flash->op_busy) {
|
|
|
+ bfa_trc(flash, flash->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ flash->op_busy = 1;
|
|
|
+ flash->cbfn = cbfn;
|
|
|
+ flash->cbarg = cbarg;
|
|
|
+ flash->type = type;
|
|
|
+ flash->instance = instance;
|
|
|
+
|
|
|
+ bfa_flash_erase_send(flash);
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Update flash partition.
|
|
|
+ *
|
|
|
+ * @param[in] flash - flash structure
|
|
|
+ * @param[in] type - flash partition type
|
|
|
+ * @param[in] instance - flash partition instance
|
|
|
+ * @param[in] buf - update data buffer
|
|
|
+ * @param[in] len - data buffer length
|
|
|
+ * @param[in] offset - offset relative to the partition starting address
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_flash_update_part(struct bfa_flash_s *flash, enum bfa_flash_part_type type,
|
|
|
+ u8 instance, void *buf, u32 len, u32 offset,
|
|
|
+ bfa_cb_flash_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(flash, BFI_FLASH_H2I_WRITE_REQ);
|
|
|
+ bfa_trc(flash, type);
|
|
|
+ bfa_trc(flash, instance);
|
|
|
+ bfa_trc(flash, len);
|
|
|
+ bfa_trc(flash, offset);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(flash->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * 'len' must be in word (4-byte) boundary
|
|
|
+ * 'offset' must be in sector (16kb) boundary
|
|
|
+ */
|
|
|
+ if (!len || (len & 0x03) || (offset & 0x00003FFF))
|
|
|
+ return BFA_STATUS_FLASH_BAD_LEN;
|
|
|
+
|
|
|
+ if (type == BFA_FLASH_PART_MFG)
|
|
|
+ return BFA_STATUS_EINVAL;
|
|
|
+
|
|
|
+ if (flash->op_busy) {
|
|
|
+ bfa_trc(flash, flash->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ flash->op_busy = 1;
|
|
|
+ flash->cbfn = cbfn;
|
|
|
+ flash->cbarg = cbarg;
|
|
|
+ flash->type = type;
|
|
|
+ flash->instance = instance;
|
|
|
+ flash->residue = len;
|
|
|
+ flash->offset = 0;
|
|
|
+ flash->addr_off = offset;
|
|
|
+ flash->ubuf = buf;
|
|
|
+
|
|
|
+ bfa_flash_write_send(flash);
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Read flash partition.
|
|
|
+ *
|
|
|
+ * @param[in] flash - flash structure
|
|
|
+ * @param[in] type - flash partition type
|
|
|
+ * @param[in] instance - flash partition instance
|
|
|
+ * @param[in] buf - read data buffer
|
|
|
+ * @param[in] len - data buffer length
|
|
|
+ * @param[in] offset - offset relative to the partition starting address
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_flash_read_part(struct bfa_flash_s *flash, enum bfa_flash_part_type type,
|
|
|
+ u8 instance, void *buf, u32 len, u32 offset,
|
|
|
+ bfa_cb_flash_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(flash, BFI_FLASH_H2I_READ_REQ);
|
|
|
+ bfa_trc(flash, type);
|
|
|
+ bfa_trc(flash, instance);
|
|
|
+ bfa_trc(flash, len);
|
|
|
+ bfa_trc(flash, offset);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(flash->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * 'len' must be in word (4-byte) boundary
|
|
|
+ * 'offset' must be in sector (16kb) boundary
|
|
|
+ */
|
|
|
+ if (!len || (len & 0x03) || (offset & 0x00003FFF))
|
|
|
+ return BFA_STATUS_FLASH_BAD_LEN;
|
|
|
+
|
|
|
+ if (flash->op_busy) {
|
|
|
+ bfa_trc(flash, flash->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ flash->op_busy = 1;
|
|
|
+ flash->cbfn = cbfn;
|
|
|
+ flash->cbarg = cbarg;
|
|
|
+ flash->type = type;
|
|
|
+ flash->instance = instance;
|
|
|
+ flash->residue = len;
|
|
|
+ flash->offset = 0;
|
|
|
+ flash->addr_off = offset;
|
|
|
+ flash->ubuf = buf;
|
|
|
+ bfa_flash_read_send(flash);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * DIAG module specific
|
|
|
+ */
|
|
|
+
|
|
|
+#define BFA_DIAG_MEMTEST_TOV 50000 /* memtest timeout in msec */
|
|
|
+#define BFA_DIAG_FWPING_TOV 1000 /* msec */
|
|
|
+
|
|
|
+/* IOC event handler */
|
|
|
+static void
|
|
|
+bfa_diag_notify(void *diag_arg, enum bfa_ioc_event_e event)
|
|
|
+{
|
|
|
+ struct bfa_diag_s *diag = diag_arg;
|
|
|
+
|
|
|
+ bfa_trc(diag, event);
|
|
|
+ bfa_trc(diag, diag->block);
|
|
|
+ bfa_trc(diag, diag->fwping.lock);
|
|
|
+ bfa_trc(diag, diag->tsensor.lock);
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case BFA_IOC_E_DISABLED:
|
|
|
+ case BFA_IOC_E_FAILED:
|
|
|
+ if (diag->fwping.lock) {
|
|
|
+ diag->fwping.status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ diag->fwping.cbfn(diag->fwping.cbarg,
|
|
|
+ diag->fwping.status);
|
|
|
+ diag->fwping.lock = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (diag->tsensor.lock) {
|
|
|
+ diag->tsensor.status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ diag->tsensor.cbfn(diag->tsensor.cbarg,
|
|
|
+ diag->tsensor.status);
|
|
|
+ diag->tsensor.lock = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (diag->block) {
|
|
|
+ if (diag->timer_active) {
|
|
|
+ bfa_timer_stop(&diag->timer);
|
|
|
+ diag->timer_active = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ diag->status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ diag->cbfn(diag->cbarg, diag->status);
|
|
|
+ diag->block = 0;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_diag_memtest_done(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_diag_s *diag = cbarg;
|
|
|
+ struct bfa_ioc_s *ioc = diag->ioc;
|
|
|
+ struct bfa_diag_memtest_result *res = diag->result;
|
|
|
+ u32 loff = BFI_BOOT_MEMTEST_RES_ADDR;
|
|
|
+ u32 pgnum, pgoff, i;
|
|
|
+
|
|
|
+ pgnum = PSS_SMEM_PGNUM(ioc->ioc_regs.smem_pg0, loff);
|
|
|
+ pgoff = PSS_SMEM_PGOFF(loff);
|
|
|
+
|
|
|
+ writel(pgnum, ioc->ioc_regs.host_page_num_fn);
|
|
|
+
|
|
|
+ for (i = 0; i < (sizeof(struct bfa_diag_memtest_result) /
|
|
|
+ sizeof(u32)); i++) {
|
|
|
+ /* read test result from smem */
|
|
|
+ *((u32 *) res + i) =
|
|
|
+ bfa_mem_read(ioc->ioc_regs.smem_page_start, loff);
|
|
|
+ loff += sizeof(u32);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Reset IOC fwstates to BFI_IOC_UNINIT */
|
|
|
+ bfa_ioc_reset_fwstate(ioc);
|
|
|
+
|
|
|
+ res->status = swab32(res->status);
|
|
|
+ bfa_trc(diag, res->status);
|
|
|
+
|
|
|
+ if (res->status == BFI_BOOT_MEMTEST_RES_SIG)
|
|
|
+ diag->status = BFA_STATUS_OK;
|
|
|
+ else {
|
|
|
+ diag->status = BFA_STATUS_MEMTEST_FAILED;
|
|
|
+ res->addr = swab32(res->addr);
|
|
|
+ res->exp = swab32(res->exp);
|
|
|
+ res->act = swab32(res->act);
|
|
|
+ res->err_status = swab32(res->err_status);
|
|
|
+ res->err_status1 = swab32(res->err_status1);
|
|
|
+ res->err_addr = swab32(res->err_addr);
|
|
|
+ bfa_trc(diag, res->addr);
|
|
|
+ bfa_trc(diag, res->exp);
|
|
|
+ bfa_trc(diag, res->act);
|
|
|
+ bfa_trc(diag, res->err_status);
|
|
|
+ bfa_trc(diag, res->err_status1);
|
|
|
+ bfa_trc(diag, res->err_addr);
|
|
|
+ }
|
|
|
+ diag->timer_active = 0;
|
|
|
+ diag->cbfn(diag->cbarg, diag->status);
|
|
|
+ diag->block = 0;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Firmware ping
|
|
|
+ */
|
|
|
+
|
|
|
+/*
|
|
|
+ * Perform DMA test directly
|
|
|
+ */
|
|
|
+static void
|
|
|
+diag_fwping_send(struct bfa_diag_s *diag)
|
|
|
+{
|
|
|
+ struct bfi_diag_fwping_req_s *fwping_req;
|
|
|
+ u32 i;
|
|
|
+
|
|
|
+ bfa_trc(diag, diag->fwping.dbuf_pa);
|
|
|
+
|
|
|
+ /* fill DMA area with pattern */
|
|
|
+ for (i = 0; i < (BFI_DIAG_DMA_BUF_SZ >> 2); i++)
|
|
|
+ *((u32 *)diag->fwping.dbuf_kva + i) = diag->fwping.data;
|
|
|
+
|
|
|
+ /* Fill mbox msg */
|
|
|
+ fwping_req = (struct bfi_diag_fwping_req_s *)diag->fwping.mbcmd.msg;
|
|
|
+
|
|
|
+ /* Setup SG list */
|
|
|
+ bfa_alen_set(&fwping_req->alen, BFI_DIAG_DMA_BUF_SZ,
|
|
|
+ diag->fwping.dbuf_pa);
|
|
|
+ /* Set up dma count */
|
|
|
+ fwping_req->count = cpu_to_be32(diag->fwping.count);
|
|
|
+ /* Set up data pattern */
|
|
|
+ fwping_req->data = diag->fwping.data;
|
|
|
+
|
|
|
+ /* build host command */
|
|
|
+ bfi_h2i_set(fwping_req->mh, BFI_MC_DIAG, BFI_DIAG_H2I_FWPING,
|
|
|
+ bfa_ioc_portid(diag->ioc));
|
|
|
+
|
|
|
+ /* send mbox cmd */
|
|
|
+ bfa_ioc_mbox_queue(diag->ioc, &diag->fwping.mbcmd);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+diag_fwping_comp(struct bfa_diag_s *diag,
|
|
|
+ struct bfi_diag_fwping_rsp_s *diag_rsp)
|
|
|
+{
|
|
|
+ u32 rsp_data = diag_rsp->data;
|
|
|
+ u8 rsp_dma_status = diag_rsp->dma_status;
|
|
|
+
|
|
|
+ bfa_trc(diag, rsp_data);
|
|
|
+ bfa_trc(diag, rsp_dma_status);
|
|
|
+
|
|
|
+ if (rsp_dma_status == BFA_STATUS_OK) {
|
|
|
+ u32 i, pat;
|
|
|
+ pat = (diag->fwping.count & 0x1) ? ~(diag->fwping.data) :
|
|
|
+ diag->fwping.data;
|
|
|
+ /* Check mbox data */
|
|
|
+ if (diag->fwping.data != rsp_data) {
|
|
|
+ bfa_trc(diag, rsp_data);
|
|
|
+ diag->fwping.result->dmastatus =
|
|
|
+ BFA_STATUS_DATACORRUPTED;
|
|
|
+ diag->fwping.status = BFA_STATUS_DATACORRUPTED;
|
|
|
+ diag->fwping.cbfn(diag->fwping.cbarg,
|
|
|
+ diag->fwping.status);
|
|
|
+ diag->fwping.lock = 0;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ /* Check dma pattern */
|
|
|
+ for (i = 0; i < (BFI_DIAG_DMA_BUF_SZ >> 2); i++) {
|
|
|
+ if (*((u32 *)diag->fwping.dbuf_kva + i) != pat) {
|
|
|
+ bfa_trc(diag, i);
|
|
|
+ bfa_trc(diag, pat);
|
|
|
+ bfa_trc(diag,
|
|
|
+ *((u32 *)diag->fwping.dbuf_kva + i));
|
|
|
+ diag->fwping.result->dmastatus =
|
|
|
+ BFA_STATUS_DATACORRUPTED;
|
|
|
+ diag->fwping.status = BFA_STATUS_DATACORRUPTED;
|
|
|
+ diag->fwping.cbfn(diag->fwping.cbarg,
|
|
|
+ diag->fwping.status);
|
|
|
+ diag->fwping.lock = 0;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ diag->fwping.result->dmastatus = BFA_STATUS_OK;
|
|
|
+ diag->fwping.status = BFA_STATUS_OK;
|
|
|
+ diag->fwping.cbfn(diag->fwping.cbarg, diag->fwping.status);
|
|
|
+ diag->fwping.lock = 0;
|
|
|
+ } else {
|
|
|
+ diag->fwping.status = BFA_STATUS_HDMA_FAILED;
|
|
|
+ diag->fwping.cbfn(diag->fwping.cbarg, diag->fwping.status);
|
|
|
+ diag->fwping.lock = 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Temperature Sensor
|
|
|
+ */
|
|
|
+
|
|
|
+static void
|
|
|
+diag_tempsensor_send(struct bfa_diag_s *diag)
|
|
|
+{
|
|
|
+ struct bfi_diag_ts_req_s *msg;
|
|
|
+
|
|
|
+ msg = (struct bfi_diag_ts_req_s *)diag->tsensor.mbcmd.msg;
|
|
|
+ bfa_trc(diag, msg->temp);
|
|
|
+ /* build host command */
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_DIAG, BFI_DIAG_H2I_TEMPSENSOR,
|
|
|
+ bfa_ioc_portid(diag->ioc));
|
|
|
+ /* send mbox cmd */
|
|
|
+ bfa_ioc_mbox_queue(diag->ioc, &diag->tsensor.mbcmd);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+diag_tempsensor_comp(struct bfa_diag_s *diag, bfi_diag_ts_rsp_t *rsp)
|
|
|
+{
|
|
|
+ if (!diag->tsensor.lock) {
|
|
|
+ /* receiving response after ioc failure */
|
|
|
+ bfa_trc(diag, diag->tsensor.lock);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * ASIC junction tempsensor is a reg read operation
|
|
|
+ * it will always return OK
|
|
|
+ */
|
|
|
+ diag->tsensor.temp->temp = be16_to_cpu(rsp->temp);
|
|
|
+ diag->tsensor.temp->ts_junc = rsp->ts_junc;
|
|
|
+ diag->tsensor.temp->ts_brd = rsp->ts_brd;
|
|
|
+ diag->tsensor.temp->status = BFA_STATUS_OK;
|
|
|
+
|
|
|
+ if (rsp->ts_brd) {
|
|
|
+ if (rsp->status == BFA_STATUS_OK) {
|
|
|
+ diag->tsensor.temp->brd_temp =
|
|
|
+ be16_to_cpu(rsp->brd_temp);
|
|
|
+ } else {
|
|
|
+ bfa_trc(diag, rsp->status);
|
|
|
+ diag->tsensor.temp->brd_temp = 0;
|
|
|
+ diag->tsensor.temp->status = BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ bfa_trc(diag, rsp->ts_junc);
|
|
|
+ bfa_trc(diag, rsp->temp);
|
|
|
+ bfa_trc(diag, rsp->ts_brd);
|
|
|
+ bfa_trc(diag, rsp->brd_temp);
|
|
|
+ diag->tsensor.cbfn(diag->tsensor.cbarg, diag->tsensor.status);
|
|
|
+ diag->tsensor.lock = 0;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * LED Test command
|
|
|
+ */
|
|
|
+static void
|
|
|
+diag_ledtest_send(struct bfa_diag_s *diag, struct bfa_diag_ledtest_s *ledtest)
|
|
|
+{
|
|
|
+ struct bfi_diag_ledtest_req_s *msg;
|
|
|
+
|
|
|
+ msg = (struct bfi_diag_ledtest_req_s *)diag->ledtest.mbcmd.msg;
|
|
|
+ /* build host command */
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_DIAG, BFI_DIAG_H2I_LEDTEST,
|
|
|
+ bfa_ioc_portid(diag->ioc));
|
|
|
+
|
|
|
+ /*
|
|
|
+ * convert the freq from N blinks per 10 sec to
|
|
|
+ * crossbow ontime value. We do it here because division is need
|
|
|
+ */
|
|
|
+ if (ledtest->freq)
|
|
|
+ ledtest->freq = 500 / ledtest->freq;
|
|
|
+
|
|
|
+ if (ledtest->freq == 0)
|
|
|
+ ledtest->freq = 1;
|
|
|
+
|
|
|
+ bfa_trc(diag, ledtest->freq);
|
|
|
+ /* mcpy(&ledtest_req->req, ledtest, sizeof(bfa_diag_ledtest_t)); */
|
|
|
+ msg->cmd = (u8) ledtest->cmd;
|
|
|
+ msg->color = (u8) ledtest->color;
|
|
|
+ msg->portid = bfa_ioc_portid(diag->ioc);
|
|
|
+ msg->led = ledtest->led;
|
|
|
+ msg->freq = cpu_to_be16(ledtest->freq);
|
|
|
+
|
|
|
+ /* send mbox cmd */
|
|
|
+ bfa_ioc_mbox_queue(diag->ioc, &diag->ledtest.mbcmd);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+diag_ledtest_comp(struct bfa_diag_s *diag, struct bfi_diag_ledtest_rsp_s * msg)
|
|
|
+{
|
|
|
+ bfa_trc(diag, diag->ledtest.lock);
|
|
|
+ diag->ledtest.lock = BFA_FALSE;
|
|
|
+ /* no bfa_cb_queue is needed because driver is not waiting */
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Port beaconing
|
|
|
+ */
|
|
|
+static void
|
|
|
+diag_portbeacon_send(struct bfa_diag_s *diag, bfa_boolean_t beacon, u32 sec)
|
|
|
+{
|
|
|
+ struct bfi_diag_portbeacon_req_s *msg;
|
|
|
+
|
|
|
+ msg = (struct bfi_diag_portbeacon_req_s *)diag->beacon.mbcmd.msg;
|
|
|
+ /* build host command */
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_DIAG, BFI_DIAG_H2I_PORTBEACON,
|
|
|
+ bfa_ioc_portid(diag->ioc));
|
|
|
+ msg->beacon = beacon;
|
|
|
+ msg->period = cpu_to_be32(sec);
|
|
|
+ /* send mbox cmd */
|
|
|
+ bfa_ioc_mbox_queue(diag->ioc, &diag->beacon.mbcmd);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+diag_portbeacon_comp(struct bfa_diag_s *diag)
|
|
|
+{
|
|
|
+ bfa_trc(diag, diag->beacon.state);
|
|
|
+ diag->beacon.state = BFA_FALSE;
|
|
|
+ if (diag->cbfn_beacon)
|
|
|
+ diag->cbfn_beacon(diag->dev, BFA_FALSE, diag->beacon.link_e2e);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Diag hmbox handler
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_diag_intr(void *diagarg, struct bfi_mbmsg_s *msg)
|
|
|
+{
|
|
|
+ struct bfa_diag_s *diag = diagarg;
|
|
|
+
|
|
|
+ switch (msg->mh.msg_id) {
|
|
|
+ case BFI_DIAG_I2H_PORTBEACON:
|
|
|
+ diag_portbeacon_comp(diag);
|
|
|
+ break;
|
|
|
+ case BFI_DIAG_I2H_FWPING:
|
|
|
+ diag_fwping_comp(diag, (struct bfi_diag_fwping_rsp_s *) msg);
|
|
|
+ break;
|
|
|
+ case BFI_DIAG_I2H_TEMPSENSOR:
|
|
|
+ diag_tempsensor_comp(diag, (bfi_diag_ts_rsp_t *) msg);
|
|
|
+ break;
|
|
|
+ case BFI_DIAG_I2H_LEDTEST:
|
|
|
+ diag_ledtest_comp(diag, (struct bfi_diag_ledtest_rsp_s *) msg);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ bfa_trc(diag, msg->mh.msg_id);
|
|
|
+ WARN_ON(1);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Gen RAM Test
|
|
|
+ *
|
|
|
+ * @param[in] *diag - diag data struct
|
|
|
+ * @param[in] *memtest - mem test params input from upper layer,
|
|
|
+ * @param[in] pattern - mem test pattern
|
|
|
+ * @param[in] *result - mem test result
|
|
|
+ * @param[in] cbfn - mem test callback functioin
|
|
|
+ * @param[in] cbarg - callback functioin arg
|
|
|
+ *
|
|
|
+ * @param[out]
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_diag_memtest(struct bfa_diag_s *diag, struct bfa_diag_memtest_s *memtest,
|
|
|
+ u32 pattern, struct bfa_diag_memtest_result *result,
|
|
|
+ bfa_cb_diag_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(diag, pattern);
|
|
|
+
|
|
|
+ if (!bfa_ioc_adapter_is_disabled(diag->ioc))
|
|
|
+ return BFA_STATUS_ADAPTER_ENABLED;
|
|
|
+
|
|
|
+ /* check to see if there is another destructive diag cmd running */
|
|
|
+ if (diag->block) {
|
|
|
+ bfa_trc(diag, diag->block);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ } else
|
|
|
+ diag->block = 1;
|
|
|
+
|
|
|
+ diag->result = result;
|
|
|
+ diag->cbfn = cbfn;
|
|
|
+ diag->cbarg = cbarg;
|
|
|
+
|
|
|
+ /* download memtest code and take LPU0 out of reset */
|
|
|
+ bfa_ioc_boot(diag->ioc, BFI_FWBOOT_TYPE_MEMTEST, BFI_FWBOOT_ENV_OS);
|
|
|
+
|
|
|
+ bfa_timer_begin(diag->ioc->timer_mod, &diag->timer,
|
|
|
+ bfa_diag_memtest_done, diag, BFA_DIAG_MEMTEST_TOV);
|
|
|
+ diag->timer_active = 1;
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * DIAG firmware ping command
|
|
|
+ *
|
|
|
+ * @param[in] *diag - diag data struct
|
|
|
+ * @param[in] cnt - dma loop count for testing PCIE
|
|
|
+ * @param[in] data - data pattern to pass in fw
|
|
|
+ * @param[in] *result - pt to bfa_diag_fwping_result_t data struct
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] *cbarg - callback functioin arg
|
|
|
+ *
|
|
|
+ * @param[out]
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_diag_fwping(struct bfa_diag_s *diag, u32 cnt, u32 data,
|
|
|
+ struct bfa_diag_results_fwping *result, bfa_cb_diag_t cbfn,
|
|
|
+ void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(diag, cnt);
|
|
|
+ bfa_trc(diag, data);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(diag->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (bfa_asic_id_ct2(bfa_ioc_devid((diag->ioc))) &&
|
|
|
+ ((diag->ioc)->clscode == BFI_PCIFN_CLASS_ETH))
|
|
|
+ return BFA_STATUS_CMD_NOTSUPP;
|
|
|
+
|
|
|
+ /* check to see if there is another destructive diag cmd running */
|
|
|
+ if (diag->block || diag->fwping.lock) {
|
|
|
+ bfa_trc(diag, diag->block);
|
|
|
+ bfa_trc(diag, diag->fwping.lock);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Initialization */
|
|
|
+ diag->fwping.lock = 1;
|
|
|
+ diag->fwping.cbfn = cbfn;
|
|
|
+ diag->fwping.cbarg = cbarg;
|
|
|
+ diag->fwping.result = result;
|
|
|
+ diag->fwping.data = data;
|
|
|
+ diag->fwping.count = cnt;
|
|
|
+
|
|
|
+ /* Init test results */
|
|
|
+ diag->fwping.result->data = 0;
|
|
|
+ diag->fwping.result->status = BFA_STATUS_OK;
|
|
|
+
|
|
|
+ /* kick off the first ping */
|
|
|
+ diag_fwping_send(diag);
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Read Temperature Sensor
|
|
|
+ *
|
|
|
+ * @param[in] *diag - diag data struct
|
|
|
+ * @param[in] *result - pt to bfa_diag_temp_t data struct
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] *cbarg - callback functioin arg
|
|
|
+ *
|
|
|
+ * @param[out]
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_diag_tsensor_query(struct bfa_diag_s *diag,
|
|
|
+ struct bfa_diag_results_tempsensor_s *result,
|
|
|
+ bfa_cb_diag_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ /* check to see if there is a destructive diag cmd running */
|
|
|
+ if (diag->block || diag->tsensor.lock) {
|
|
|
+ bfa_trc(diag, diag->block);
|
|
|
+ bfa_trc(diag, diag->tsensor.lock);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(diag->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ /* Init diag mod params */
|
|
|
+ diag->tsensor.lock = 1;
|
|
|
+ diag->tsensor.temp = result;
|
|
|
+ diag->tsensor.cbfn = cbfn;
|
|
|
+ diag->tsensor.cbarg = cbarg;
|
|
|
+
|
|
|
+ /* Send msg to fw */
|
|
|
+ diag_tempsensor_send(diag);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * LED Test command
|
|
|
+ *
|
|
|
+ * @param[in] *diag - diag data struct
|
|
|
+ * @param[in] *ledtest - pt to ledtest data structure
|
|
|
+ *
|
|
|
+ * @param[out]
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_diag_ledtest(struct bfa_diag_s *diag, struct bfa_diag_ledtest_s *ledtest)
|
|
|
+{
|
|
|
+ bfa_trc(diag, ledtest->cmd);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(diag->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (diag->beacon.state)
|
|
|
+ return BFA_STATUS_BEACON_ON;
|
|
|
+
|
|
|
+ if (diag->ledtest.lock)
|
|
|
+ return BFA_STATUS_LEDTEST_OP;
|
|
|
+
|
|
|
+ /* Send msg to fw */
|
|
|
+ diag->ledtest.lock = BFA_TRUE;
|
|
|
+ diag_ledtest_send(diag, ledtest);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Port beaconing command
|
|
|
+ *
|
|
|
+ * @param[in] *diag - diag data struct
|
|
|
+ * @param[in] beacon - port beaconing 1:ON 0:OFF
|
|
|
+ * @param[in] link_e2e_beacon - link beaconing 1:ON 0:OFF
|
|
|
+ * @param[in] sec - beaconing duration in seconds
|
|
|
+ *
|
|
|
+ * @param[out]
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_diag_beacon_port(struct bfa_diag_s *diag, bfa_boolean_t beacon,
|
|
|
+ bfa_boolean_t link_e2e_beacon, uint32_t sec)
|
|
|
+{
|
|
|
+ bfa_trc(diag, beacon);
|
|
|
+ bfa_trc(diag, link_e2e_beacon);
|
|
|
+ bfa_trc(diag, sec);
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(diag->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (diag->ledtest.lock)
|
|
|
+ return BFA_STATUS_LEDTEST_OP;
|
|
|
+
|
|
|
+ if (diag->beacon.state && beacon) /* beacon alread on */
|
|
|
+ return BFA_STATUS_BEACON_ON;
|
|
|
+
|
|
|
+ diag->beacon.state = beacon;
|
|
|
+ diag->beacon.link_e2e = link_e2e_beacon;
|
|
|
+ if (diag->cbfn_beacon)
|
|
|
+ diag->cbfn_beacon(diag->dev, beacon, link_e2e_beacon);
|
|
|
+
|
|
|
+ /* Send msg to fw */
|
|
|
+ diag_portbeacon_send(diag, beacon, sec);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Return DMA memory needed by diag module.
|
|
|
+ */
|
|
|
+u32
|
|
|
+bfa_diag_meminfo(void)
|
|
|
+{
|
|
|
+ return BFA_ROUNDUP(BFI_DIAG_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Attach virtual and physical memory for Diag.
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_diag_attach(struct bfa_diag_s *diag, struct bfa_ioc_s *ioc, void *dev,
|
|
|
+ bfa_cb_diag_beacon_t cbfn_beacon, struct bfa_trc_mod_s *trcmod)
|
|
|
+{
|
|
|
+ diag->dev = dev;
|
|
|
+ diag->ioc = ioc;
|
|
|
+ diag->trcmod = trcmod;
|
|
|
+
|
|
|
+ diag->block = 0;
|
|
|
+ diag->cbfn = NULL;
|
|
|
+ diag->cbarg = NULL;
|
|
|
+ diag->result = NULL;
|
|
|
+ diag->cbfn_beacon = cbfn_beacon;
|
|
|
+
|
|
|
+ bfa_ioc_mbox_regisr(diag->ioc, BFI_MC_DIAG, bfa_diag_intr, diag);
|
|
|
+ bfa_q_qe_init(&diag->ioc_notify);
|
|
|
+ bfa_ioc_notify_init(&diag->ioc_notify, bfa_diag_notify, diag);
|
|
|
+ list_add_tail(&diag->ioc_notify.qe, &diag->ioc->notify_q);
|
|
|
+}
|
|
|
+
|
|
|
+void
|
|
|
+bfa_diag_memclaim(struct bfa_diag_s *diag, u8 *dm_kva, u64 dm_pa)
|
|
|
+{
|
|
|
+ diag->fwping.dbuf_kva = dm_kva;
|
|
|
+ diag->fwping.dbuf_pa = dm_pa;
|
|
|
+ memset(diag->fwping.dbuf_kva, 0, BFI_DIAG_DMA_BUF_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * PHY module specific
|
|
|
+ */
|
|
|
+#define BFA_PHY_DMA_BUF_SZ 0x02000 /* 8k dma buffer */
|
|
|
+#define BFA_PHY_LOCK_STATUS 0x018878 /* phy semaphore status reg */
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_phy_ntoh32(u32 *obuf, u32 *ibuf, int sz)
|
|
|
+{
|
|
|
+ int i, m = sz >> 2;
|
|
|
+
|
|
|
+ for (i = 0; i < m; i++)
|
|
|
+ obuf[i] = be32_to_cpu(ibuf[i]);
|
|
|
+}
|
|
|
+
|
|
|
+static bfa_boolean_t
|
|
|
+bfa_phy_present(struct bfa_phy_s *phy)
|
|
|
+{
|
|
|
+ return (phy->ioc->attr->card_type == BFA_MFG_TYPE_LIGHTNING);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+bfa_phy_notify(void *cbarg, enum bfa_ioc_event_e event)
|
|
|
+{
|
|
|
+ struct bfa_phy_s *phy = cbarg;
|
|
|
+
|
|
|
+ bfa_trc(phy, event);
|
|
|
+
|
|
|
+ switch (event) {
|
|
|
+ case BFA_IOC_E_DISABLED:
|
|
|
+ case BFA_IOC_E_FAILED:
|
|
|
+ if (phy->op_busy) {
|
|
|
+ phy->status = BFA_STATUS_IOC_FAILURE;
|
|
|
+ phy->cbfn(phy->cbarg, phy->status);
|
|
|
+ phy->op_busy = 0;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send phy attribute query request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_phy_query_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_phy_s *phy = cbarg;
|
|
|
+ struct bfi_phy_query_req_s *msg =
|
|
|
+ (struct bfi_phy_query_req_s *) phy->mb.msg;
|
|
|
+
|
|
|
+ msg->instance = phy->instance;
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_PHY, BFI_PHY_H2I_QUERY_REQ,
|
|
|
+ bfa_ioc_portid(phy->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, sizeof(struct bfa_phy_attr_s), phy->dbuf_pa);
|
|
|
+ bfa_ioc_mbox_queue(phy->ioc, &phy->mb);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send phy write request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_phy_write_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_phy_s *phy = cbarg;
|
|
|
+ struct bfi_phy_write_req_s *msg =
|
|
|
+ (struct bfi_phy_write_req_s *) phy->mb.msg;
|
|
|
+ u32 len;
|
|
|
+ u16 *buf, *dbuf;
|
|
|
+ int i, sz;
|
|
|
+
|
|
|
+ msg->instance = phy->instance;
|
|
|
+ msg->offset = cpu_to_be32(phy->addr_off + phy->offset);
|
|
|
+ len = (phy->residue < BFA_PHY_DMA_BUF_SZ) ?
|
|
|
+ phy->residue : BFA_PHY_DMA_BUF_SZ;
|
|
|
+ msg->length = cpu_to_be32(len);
|
|
|
+
|
|
|
+ /* indicate if it's the last msg of the whole write operation */
|
|
|
+ msg->last = (len == phy->residue) ? 1 : 0;
|
|
|
+
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_PHY, BFI_PHY_H2I_WRITE_REQ,
|
|
|
+ bfa_ioc_portid(phy->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, len, phy->dbuf_pa);
|
|
|
+
|
|
|
+ buf = (u16 *) (phy->ubuf + phy->offset);
|
|
|
+ dbuf = (u16 *)phy->dbuf_kva;
|
|
|
+ sz = len >> 1;
|
|
|
+ for (i = 0; i < sz; i++)
|
|
|
+ buf[i] = cpu_to_be16(dbuf[i]);
|
|
|
+
|
|
|
+ bfa_ioc_mbox_queue(phy->ioc, &phy->mb);
|
|
|
+
|
|
|
+ phy->residue -= len;
|
|
|
+ phy->offset += len;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send phy read request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_phy_read_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_phy_s *phy = cbarg;
|
|
|
+ struct bfi_phy_read_req_s *msg =
|
|
|
+ (struct bfi_phy_read_req_s *) phy->mb.msg;
|
|
|
+ u32 len;
|
|
|
+
|
|
|
+ msg->instance = phy->instance;
|
|
|
+ msg->offset = cpu_to_be32(phy->addr_off + phy->offset);
|
|
|
+ len = (phy->residue < BFA_PHY_DMA_BUF_SZ) ?
|
|
|
+ phy->residue : BFA_PHY_DMA_BUF_SZ;
|
|
|
+ msg->length = cpu_to_be32(len);
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_PHY, BFI_PHY_H2I_READ_REQ,
|
|
|
+ bfa_ioc_portid(phy->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, len, phy->dbuf_pa);
|
|
|
+ bfa_ioc_mbox_queue(phy->ioc, &phy->mb);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Send phy stats request.
|
|
|
+ *
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ */
|
|
|
+static void
|
|
|
+bfa_phy_stats_send(void *cbarg)
|
|
|
+{
|
|
|
+ struct bfa_phy_s *phy = cbarg;
|
|
|
+ struct bfi_phy_stats_req_s *msg =
|
|
|
+ (struct bfi_phy_stats_req_s *) phy->mb.msg;
|
|
|
+
|
|
|
+ msg->instance = phy->instance;
|
|
|
+ bfi_h2i_set(msg->mh, BFI_MC_PHY, BFI_PHY_H2I_STATS_REQ,
|
|
|
+ bfa_ioc_portid(phy->ioc));
|
|
|
+ bfa_alen_set(&msg->alen, sizeof(struct bfa_phy_stats_s), phy->dbuf_pa);
|
|
|
+ bfa_ioc_mbox_queue(phy->ioc, &phy->mb);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Flash memory info API.
|
|
|
+ *
|
|
|
+ * @param[in] mincfg - minimal cfg variable
|
|
|
+ */
|
|
|
+u32
|
|
|
+bfa_phy_meminfo(bfa_boolean_t mincfg)
|
|
|
+{
|
|
|
+ /* min driver doesn't need phy */
|
|
|
+ if (mincfg)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ return BFA_ROUNDUP(BFA_PHY_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Flash attach API.
|
|
|
+ *
|
|
|
+ * @param[in] phy - phy structure
|
|
|
+ * @param[in] ioc - ioc structure
|
|
|
+ * @param[in] dev - device structure
|
|
|
+ * @param[in] trcmod - trace module
|
|
|
+ * @param[in] logmod - log module
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_phy_attach(struct bfa_phy_s *phy, struct bfa_ioc_s *ioc, void *dev,
|
|
|
+ struct bfa_trc_mod_s *trcmod, bfa_boolean_t mincfg)
|
|
|
+{
|
|
|
+ phy->ioc = ioc;
|
|
|
+ phy->trcmod = trcmod;
|
|
|
+ phy->cbfn = NULL;
|
|
|
+ phy->cbarg = NULL;
|
|
|
+ phy->op_busy = 0;
|
|
|
+
|
|
|
+ bfa_ioc_mbox_regisr(phy->ioc, BFI_MC_PHY, bfa_phy_intr, phy);
|
|
|
+ bfa_q_qe_init(&phy->ioc_notify);
|
|
|
+ bfa_ioc_notify_init(&phy->ioc_notify, bfa_phy_notify, phy);
|
|
|
+ list_add_tail(&phy->ioc_notify.qe, &phy->ioc->notify_q);
|
|
|
+
|
|
|
+ /* min driver doesn't need phy */
|
|
|
+ if (mincfg) {
|
|
|
+ phy->dbuf_kva = NULL;
|
|
|
+ phy->dbuf_pa = 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Claim memory for phy
|
|
|
+ *
|
|
|
+ * @param[in] phy - phy structure
|
|
|
+ * @param[in] dm_kva - pointer to virtual memory address
|
|
|
+ * @param[in] dm_pa - physical memory address
|
|
|
+ * @param[in] mincfg - minimal cfg variable
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_phy_memclaim(struct bfa_phy_s *phy, u8 *dm_kva, u64 dm_pa,
|
|
|
+ bfa_boolean_t mincfg)
|
|
|
+{
|
|
|
+ if (mincfg)
|
|
|
+ return;
|
|
|
+
|
|
|
+ phy->dbuf_kva = dm_kva;
|
|
|
+ phy->dbuf_pa = dm_pa;
|
|
|
+ memset(phy->dbuf_kva, 0, BFA_PHY_DMA_BUF_SZ);
|
|
|
+ dm_kva += BFA_ROUNDUP(BFA_PHY_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+ dm_pa += BFA_ROUNDUP(BFA_PHY_DMA_BUF_SZ, BFA_DMA_ALIGN_SZ);
|
|
|
+}
|
|
|
+
|
|
|
+bfa_boolean_t
|
|
|
+bfa_phy_busy(struct bfa_ioc_s *ioc)
|
|
|
+{
|
|
|
+ void __iomem *rb;
|
|
|
+
|
|
|
+ rb = bfa_ioc_bar0(ioc);
|
|
|
+ return readl(rb + BFA_PHY_LOCK_STATUS);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Get phy attribute.
|
|
|
+ *
|
|
|
+ * @param[in] phy - phy structure
|
|
|
+ * @param[in] attr - phy attribute structure
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_phy_get_attr(struct bfa_phy_s *phy, u8 instance,
|
|
|
+ struct bfa_phy_attr_s *attr, bfa_cb_phy_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(phy, BFI_PHY_H2I_QUERY_REQ);
|
|
|
+ bfa_trc(phy, instance);
|
|
|
+
|
|
|
+ if (!bfa_phy_present(phy))
|
|
|
+ return BFA_STATUS_PHY_NOT_PRESENT;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(phy->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (phy->op_busy || bfa_phy_busy(phy->ioc)) {
|
|
|
+ bfa_trc(phy, phy->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ phy->op_busy = 1;
|
|
|
+ phy->cbfn = cbfn;
|
|
|
+ phy->cbarg = cbarg;
|
|
|
+ phy->instance = instance;
|
|
|
+ phy->ubuf = (uint8_t *) attr;
|
|
|
+ bfa_phy_query_send(phy);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Get phy stats.
|
|
|
+ *
|
|
|
+ * @param[in] phy - phy structure
|
|
|
+ * @param[in] instance - phy image instance
|
|
|
+ * @param[in] stats - pointer to phy stats
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_phy_get_stats(struct bfa_phy_s *phy, u8 instance,
|
|
|
+ struct bfa_phy_stats_s *stats,
|
|
|
+ bfa_cb_phy_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(phy, BFI_PHY_H2I_STATS_REQ);
|
|
|
+ bfa_trc(phy, instance);
|
|
|
+
|
|
|
+ if (!bfa_phy_present(phy))
|
|
|
+ return BFA_STATUS_PHY_NOT_PRESENT;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(phy->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ if (phy->op_busy || bfa_phy_busy(phy->ioc)) {
|
|
|
+ bfa_trc(phy, phy->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ phy->op_busy = 1;
|
|
|
+ phy->cbfn = cbfn;
|
|
|
+ phy->cbarg = cbarg;
|
|
|
+ phy->instance = instance;
|
|
|
+ phy->ubuf = (u8 *) stats;
|
|
|
+ bfa_phy_stats_send(phy);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Update phy image.
|
|
|
+ *
|
|
|
+ * @param[in] phy - phy structure
|
|
|
+ * @param[in] instance - phy image instance
|
|
|
+ * @param[in] buf - update data buffer
|
|
|
+ * @param[in] len - data buffer length
|
|
|
+ * @param[in] offset - offset relative to starting address
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_phy_update(struct bfa_phy_s *phy, u8 instance,
|
|
|
+ void *buf, u32 len, u32 offset,
|
|
|
+ bfa_cb_phy_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(phy, BFI_PHY_H2I_WRITE_REQ);
|
|
|
+ bfa_trc(phy, instance);
|
|
|
+ bfa_trc(phy, len);
|
|
|
+ bfa_trc(phy, offset);
|
|
|
+
|
|
|
+ if (!bfa_phy_present(phy))
|
|
|
+ return BFA_STATUS_PHY_NOT_PRESENT;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(phy->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ /* 'len' must be in word (4-byte) boundary */
|
|
|
+ if (!len || (len & 0x03))
|
|
|
+ return BFA_STATUS_FAILED;
|
|
|
+
|
|
|
+ if (phy->op_busy || bfa_phy_busy(phy->ioc)) {
|
|
|
+ bfa_trc(phy, phy->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ phy->op_busy = 1;
|
|
|
+ phy->cbfn = cbfn;
|
|
|
+ phy->cbarg = cbarg;
|
|
|
+ phy->instance = instance;
|
|
|
+ phy->residue = len;
|
|
|
+ phy->offset = 0;
|
|
|
+ phy->addr_off = offset;
|
|
|
+ phy->ubuf = buf;
|
|
|
+
|
|
|
+ bfa_phy_write_send(phy);
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Read phy image.
|
|
|
+ *
|
|
|
+ * @param[in] phy - phy structure
|
|
|
+ * @param[in] instance - phy image instance
|
|
|
+ * @param[in] buf - read data buffer
|
|
|
+ * @param[in] len - data buffer length
|
|
|
+ * @param[in] offset - offset relative to starting address
|
|
|
+ * @param[in] cbfn - callback function
|
|
|
+ * @param[in] cbarg - callback argument
|
|
|
+ *
|
|
|
+ * Return status.
|
|
|
+ */
|
|
|
+bfa_status_t
|
|
|
+bfa_phy_read(struct bfa_phy_s *phy, u8 instance,
|
|
|
+ void *buf, u32 len, u32 offset,
|
|
|
+ bfa_cb_phy_t cbfn, void *cbarg)
|
|
|
+{
|
|
|
+ bfa_trc(phy, BFI_PHY_H2I_READ_REQ);
|
|
|
+ bfa_trc(phy, instance);
|
|
|
+ bfa_trc(phy, len);
|
|
|
+ bfa_trc(phy, offset);
|
|
|
+
|
|
|
+ if (!bfa_phy_present(phy))
|
|
|
+ return BFA_STATUS_PHY_NOT_PRESENT;
|
|
|
+
|
|
|
+ if (!bfa_ioc_is_operational(phy->ioc))
|
|
|
+ return BFA_STATUS_IOC_NON_OP;
|
|
|
+
|
|
|
+ /* 'len' must be in word (4-byte) boundary */
|
|
|
+ if (!len || (len & 0x03))
|
|
|
+ return BFA_STATUS_FAILED;
|
|
|
+
|
|
|
+ if (phy->op_busy || bfa_phy_busy(phy->ioc)) {
|
|
|
+ bfa_trc(phy, phy->op_busy);
|
|
|
+ return BFA_STATUS_DEVBUSY;
|
|
|
+ }
|
|
|
+
|
|
|
+ phy->op_busy = 1;
|
|
|
+ phy->cbfn = cbfn;
|
|
|
+ phy->cbarg = cbarg;
|
|
|
+ phy->instance = instance;
|
|
|
+ phy->residue = len;
|
|
|
+ phy->offset = 0;
|
|
|
+ phy->addr_off = offset;
|
|
|
+ phy->ubuf = buf;
|
|
|
+ bfa_phy_read_send(phy);
|
|
|
+
|
|
|
+ return BFA_STATUS_OK;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Process phy response messages upon receiving interrupts.
|
|
|
+ *
|
|
|
+ * @param[in] phyarg - phy structure
|
|
|
+ * @param[in] msg - message structure
|
|
|
+ */
|
|
|
+void
|
|
|
+bfa_phy_intr(void *phyarg, struct bfi_mbmsg_s *msg)
|
|
|
+{
|
|
|
+ struct bfa_phy_s *phy = phyarg;
|
|
|
+ u32 status;
|
|
|
+
|
|
|
+ union {
|
|
|
+ struct bfi_phy_query_rsp_s *query;
|
|
|
+ struct bfi_phy_stats_rsp_s *stats;
|
|
|
+ struct bfi_phy_write_rsp_s *write;
|
|
|
+ struct bfi_phy_read_rsp_s *read;
|
|
|
+ struct bfi_mbmsg_s *msg;
|
|
|
+ } m;
|
|
|
+
|
|
|
+ m.msg = msg;
|
|
|
+ bfa_trc(phy, msg->mh.msg_id);
|
|
|
+
|
|
|
+ if (!phy->op_busy) {
|
|
|
+ /* receiving response after ioc failure */
|
|
|
+ bfa_trc(phy, 0x9999);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ switch (msg->mh.msg_id) {
|
|
|
+ case BFI_PHY_I2H_QUERY_RSP:
|
|
|
+ status = be32_to_cpu(m.query->status);
|
|
|
+ bfa_trc(phy, status);
|
|
|
+
|
|
|
+ if (status == BFA_STATUS_OK) {
|
|
|
+ struct bfa_phy_attr_s *attr =
|
|
|
+ (struct bfa_phy_attr_s *) phy->ubuf;
|
|
|
+ bfa_phy_ntoh32((u32 *)attr, (u32 *)phy->dbuf_kva,
|
|
|
+ sizeof(struct bfa_phy_attr_s));
|
|
|
+ bfa_trc(phy, attr->status);
|
|
|
+ bfa_trc(phy, attr->length);
|
|
|
+ }
|
|
|
+
|
|
|
+ phy->status = status;
|
|
|
+ phy->op_busy = 0;
|
|
|
+ if (phy->cbfn)
|
|
|
+ phy->cbfn(phy->cbarg, phy->status);
|
|
|
+ break;
|
|
|
+ case BFI_PHY_I2H_STATS_RSP:
|
|
|
+ status = be32_to_cpu(m.stats->status);
|
|
|
+ bfa_trc(phy, status);
|
|
|
+
|
|
|
+ if (status == BFA_STATUS_OK) {
|
|
|
+ struct bfa_phy_stats_s *stats =
|
|
|
+ (struct bfa_phy_stats_s *) phy->ubuf;
|
|
|
+ bfa_phy_ntoh32((u32 *)stats, (u32 *)phy->dbuf_kva,
|
|
|
+ sizeof(struct bfa_phy_stats_s));
|
|
|
+ bfa_trc(phy, stats->status);
|
|
|
+ }
|
|
|
+
|
|
|
+ phy->status = status;
|
|
|
+ phy->op_busy = 0;
|
|
|
+ if (phy->cbfn)
|
|
|
+ phy->cbfn(phy->cbarg, phy->status);
|
|
|
+ break;
|
|
|
+ case BFI_PHY_I2H_WRITE_RSP:
|
|
|
+ status = be32_to_cpu(m.write->status);
|
|
|
+ bfa_trc(phy, status);
|
|
|
+
|
|
|
+ if (status != BFA_STATUS_OK || phy->residue == 0) {
|
|
|
+ phy->status = status;
|
|
|
+ phy->op_busy = 0;
|
|
|
+ if (phy->cbfn)
|
|
|
+ phy->cbfn(phy->cbarg, phy->status);
|
|
|
+ } else {
|
|
|
+ bfa_trc(phy, phy->offset);
|
|
|
+ bfa_phy_write_send(phy);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case BFI_PHY_I2H_READ_RSP:
|
|
|
+ status = be32_to_cpu(m.read->status);
|
|
|
+ bfa_trc(phy, status);
|
|
|
+
|
|
|
+ if (status != BFA_STATUS_OK) {
|
|
|
+ phy->status = status;
|
|
|
+ phy->op_busy = 0;
|
|
|
+ if (phy->cbfn)
|
|
|
+ phy->cbfn(phy->cbarg, phy->status);
|
|
|
+ } else {
|
|
|
+ u32 len = be32_to_cpu(m.read->length);
|
|
|
+ u16 *buf = (u16 *)(phy->ubuf + phy->offset);
|
|
|
+ u16 *dbuf = (u16 *)phy->dbuf_kva;
|
|
|
+ int i, sz = len >> 1;
|
|
|
+
|
|
|
+ bfa_trc(phy, phy->offset);
|
|
|
+ bfa_trc(phy, len);
|
|
|
+
|
|
|
+ for (i = 0; i < sz; i++)
|
|
|
+ buf[i] = be16_to_cpu(dbuf[i]);
|
|
|
+
|
|
|
+ phy->residue -= len;
|
|
|
+ phy->offset += len;
|
|
|
+
|
|
|
+ if (phy->residue == 0) {
|
|
|
+ phy->status = status;
|
|
|
+ phy->op_busy = 0;
|
|
|
+ if (phy->cbfn)
|
|
|
+ phy->cbfn(phy->cbarg, phy->status);
|
|
|
+ } else
|
|
|
+ bfa_phy_read_send(phy);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ }
|
|
|
+}
|