mtd: st_spi_fsm: Add the ability to read the FSM's status (ac94dbcb) · Commits · 戴 / test

drivers/mtd/devices/st_spi_fsm.c

+24 −0

Original line number	Diff line number	Diff line
		@@ -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;