mtd: st_spi_fsm: Add the ability to read the FSM's status
Acked-by Angus Clark <angus.clark@st.com> Signed-off-by: Lee Jones <lee.jones@linaro.org> Signed-off-by: Brian Norris <computersforpeace@gmail.com>
This commit is contained in:
parent
4a341fe758
commit
ac94dbcb67
|
@ -793,6 +793,30 @@ static uint8_t stfsm_wait_busy(struct stfsm *fsm)
|
||||||
return FLASH_STATUS_TIMEOUT;
|
return FLASH_STATUS_TIMEOUT;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int stfsm_read_status(struct stfsm *fsm, uint8_t cmd,
|
||||||
|
uint8_t *status)
|
||||||
|
{
|
||||||
|
struct stfsm_seq *seq = &stfsm_seq_read_status_fifo;
|
||||||
|
uint32_t tmp;
|
||||||
|
|
||||||
|
dev_dbg(fsm->dev, "reading STA[%s]\n",
|
||||||
|
(cmd == FLASH_CMD_RDSR) ? "1" : "2");
|
||||||
|
|
||||||
|
seq->seq_opc[0] = (SEQ_OPC_PADS_1 |
|
||||||
|
SEQ_OPC_CYCLES(8) |
|
||||||
|
SEQ_OPC_OPCODE(cmd)),
|
||||||
|
|
||||||
|
stfsm_load_seq(fsm, seq);
|
||||||
|
|
||||||
|
stfsm_read_fifo(fsm, &tmp, 4);
|
||||||
|
|
||||||
|
*status = (uint8_t)(tmp >> 24);
|
||||||
|
|
||||||
|
stfsm_wait_seq(fsm);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static int stfsm_wrvcr(struct stfsm *fsm, uint8_t data)
|
static int stfsm_wrvcr(struct stfsm *fsm, uint8_t data)
|
||||||
{
|
{
|
||||||
struct stfsm_seq *seq = &stfsm_seq_wrvcr;
|
struct stfsm_seq *seq = &stfsm_seq_wrvcr;
|
||||||
|
|
Loading…
Reference in New Issue