aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/mtd/devices/st_spi_fsm.c24
1 files changed, 24 insertions, 0 deletions
diff --git a/drivers/mtd/devices/st_spi_fsm.c b/drivers/mtd/devices/st_spi_fsm.c
index 34aac3f49ba9..5e315e31a839 100644
--- 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)
793 return FLASH_STATUS_TIMEOUT; 793 return FLASH_STATUS_TIMEOUT;
794} 794}
795 795
796static int stfsm_read_status(struct stfsm *fsm, uint8_t cmd,
797 uint8_t *status)
798{
799 struct stfsm_seq *seq = &stfsm_seq_read_status_fifo;
800 uint32_t tmp;
801
802 dev_dbg(fsm->dev, "reading STA[%s]\n",
803 (cmd == FLASH_CMD_RDSR) ? "1" : "2");
804
805 seq->seq_opc[0] = (SEQ_OPC_PADS_1 |
806 SEQ_OPC_CYCLES(8) |
807 SEQ_OPC_OPCODE(cmd)),
808
809 stfsm_load_seq(fsm, seq);
810
811 stfsm_read_fifo(fsm, &tmp, 4);
812
813 *status = (uint8_t)(tmp >> 24);
814
815 stfsm_wait_seq(fsm);
816
817 return 0;
818}
819
796static int stfsm_wrvcr(struct stfsm *fsm, uint8_t data) 820static int stfsm_wrvcr(struct stfsm *fsm, uint8_t data)
797{ 821{
798 struct stfsm_seq *seq = &stfsm_seq_wrvcr; 822 struct stfsm_seq *seq = &stfsm_seq_wrvcr;