On Mon, 22 Oct 2018 10:03:55 +0000 Yogesh Narayan Gaur <yogeshnarayan.gaur@xxxxxxx> wrote: > --- a/drivers/mtd/spi-nor/spi-nor.c > +++ b/drivers/mtd/spi-nor/spi-nor.c > @@ -2863,26 +2863,36 @@ static u8 spi_nor_smpt_read_dummy(const struct spi_nor *nor, const u32 settings) > * @nor: pointer to a 'struct spi_nor' > * @smpt: pointer to the sector map parameter table > */ > -static const u32 *spi_nor_get_map_in_use(struct spi_nor *nor, const u32 *smpt) > +static const u32 *spi_nor_get_map_in_use(struct spi_nor *nor, const u32 *smpt, u32 smpt_len) > { > const u32 *ret = NULL; > - u32 i, addr; > + u32 i, addr, nmaps; > int err; > u8 addr_width, read_opcode, read_dummy; > u8 read_data_mask, data_byte, map_id; > + bool map_id_is_valid = false; > > addr_width = nor->addr_width; > read_dummy = nor->read_dummy; > read_opcode = nor->read_opcode; > > + pr_info("Start [addr_width:%08x, read_dumy:%0x8, read_opcode:%08x]\n", nor->addr_width, nor->read_dummy, nor->read_opcode); > + > + for (i = 0; i<smpt_len; i++) > + pr_info("%s:%i smpt[%d]=%08x\n", __func__, __LINE__, i, smpt[i]); > + > map_id = 0; > - i = 0; > /* Determine if there are any optional Detection Command Descriptors */ > - while (!(smpt[i] & SMPT_DESC_TYPE_MAP)) { > + for (i = 0; i< smpt_len; i++) { ^ i += 2) { > + if ((smpt[i] & SMPT_DESC_TYPE_MAP)) > + break; > + > read_data_mask = SMPT_CMD_READ_DATA(smpt[i]); > nor->addr_width = spi_nor_smpt_addr_width(nor, smpt[i]); > nor->read_dummy = spi_nor_smpt_read_dummy(nor, smpt[i]); > nor->read_opcode = SMPT_CMD_OPCODE(smpt[i]); > + pr_info("smpt[%d]=[addr_width:%08x, read_dumy:%0x8, read_opcode:%08x]\n", i, nor->addr_width, nor->read_dummy, nor->read_opcode); > + > addr = smpt[i + 1]; > > err = spi_nor_read_raw(nor, addr, 1, &data_byte); > @@ -2894,18 +2904,36 @@ static const u32 *spi_nor_get_map_in_use(struct spi_nor *nor, const u32 *smpt) > * Configuration that is currently in use. > */ > map_id = map_id << 1 | !!(data_byte & read_data_mask); > + map_id_is_valid = true; > i = i + 2; Drop the above line (i = i + 2). > } > > - /* Find the matching configuration map */ > - while (SMPT_MAP_ID(smpt[i]) != map_id) { > - if (smpt[i] & SMPT_DESC_END) > - goto out; > + if (map_id_is_valid) > + pr_info("%s:%i map_id=%d\n", __func__, __LINE__, map_id); > + else > + pr_info("%s:%i NO map_id\n", __func__, __LINE__); > + > + for (nmaps = 0; i< smpt_len; nmaps++) { > + if((smpt[i] & SMPT_DESC_TYPE_MAP)) > + continue; > + > + if(!map_id_is_valid) { > + if (nmaps) { > + ret = NULL; > + break; > + } > + > + ret = smpt+i; > + } else if (map_id == SMPT_MAP_ID(smpt[i])) { > + ret = smpt+i; > + break; > + } > + > /* increment the table index to the next map */ > i += SMPT_MAP_REGION_COUNT(smpt[i]) + 1; > } > > - ret = smpt + i; > + pr_info("End [addr_width:%08x, read_dumy:%0x8, read_opcode:%08x]\n", nor->addr_width, nor->read_dummy, nor->read_opcode); > /* fall through */ > out: > nor->addr_width = addr_width; ______________________________________________________ Linux MTD discussion mailing list http://lists.infradead.org/mailman/listinfo/linux-mtd/