mtd: st_spi_fsm: Prepare read/write sequences according to configuration

Firstly we search for our preference read/write configuration based on a
given chip's capabilities. Then we actually set up the message sequence
accordingly.

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 9d1edf05701a189241bef4e7f24ddfa66632ea98..3e13d579aef87a115800e7d9ffbe1fbaf1f5f8f0 100644 (file)
--- a/drivers/mtd/devices/st_spi_fsm.c
+++ b/drivers/mtd/devices/st_spi_fsm.c
@@ -618,6 +618,23 @@ static void stfsm_prepare_rw_seq(struct stfsm *fsm,
        seq->seq[i++] = STFSM_INST_STOP;
 }
 
+static int stfsm_search_prepare_rw_seq(struct stfsm *fsm,
+                                      struct stfsm_seq *seq,
+                                      struct seq_rw_config *cfgs)
+{
+       struct seq_rw_config *config;
+
+       config = stfsm_search_seq_rw_configs(fsm, cfgs);
+       if (!config) {
+               dev_err(fsm->dev, "failed to find suitable config\n");
+               return -EINVAL;
+       }
+
+       stfsm_prepare_rw_seq(fsm, seq, config);
+
+       return 0;
+}
+
 static void stfsm_read_jedec(struct stfsm *fsm, uint8_t *const jedec)
 {
        const struct stfsm_seq *seq = &stfsm_seq_read_jedec;