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>

diff --git a/drivers/mtd/devices/st_spi_fsm.c b/drivers/mtd/devices/st_spi_fsm.c
index 34aac3f49ba9a8f40cbaad6b014d5e7e25ca1c00..5e315e31a839e7ed18f63102b1fa7a22e4caa5cc 100644 (file)
--- a/drivers/mtd/devices/st_spi_fsm.c
+++ b/drivers/mtd/devices/st_spi_fsm.c
@@ -793,6 +793,30 @@ static uint8_t stfsm_wait_busy(struct stfsm *fsm)
        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)
 {
        struct stfsm_seq *seq = &stfsm_seq_wrvcr;