diff options
Diffstat (limited to 'drivers/mtd/spi/stmicro.c')
| -rw-r--r-- | drivers/mtd/spi/stmicro.c | 26 | 
1 files changed, 24 insertions, 2 deletions
diff --git a/drivers/mtd/spi/stmicro.c b/drivers/mtd/spi/stmicro.c index ae0d0471f..31340279c 100644 --- a/drivers/mtd/spi/stmicro.c +++ b/drivers/mtd/spi/stmicro.c @@ -46,6 +46,7 @@  #define CMD_M25PXX_DP		0xb9	/* Deep Power-down */  #define CMD_M25PXX_RES		0xab	/* Release from DP, and Read Signature */ +#define STM_ID_M25P10		0x11  #define STM_ID_M25P16		0x15  #define STM_ID_M25P20		0x12  #define STM_ID_M25P32		0x16 @@ -78,6 +79,13 @@ static inline struct stmicro_spi_flash *to_stmicro_spi_flash(struct spi_flash  static const struct stmicro_spi_flash_params stmicro_spi_flash_table[] = {  	{ +		.idcode1 = STM_ID_M25P10, +		.page_size = 256, +		.pages_per_sector = 128, +		.nr_sectors = 4, +		.name = "M25P10", +	}, +	{  		.idcode1 = STM_ID_M25P16,  		.page_size = 256,  		.pages_per_sector = 256, @@ -316,6 +324,19 @@ struct spi_flash *spi_flash_probe_stmicro(struct spi_slave *spi, u8 * idcode)  	struct stmicro_spi_flash *stm;  	unsigned int i; +	if (idcode[0] == 0xff) { +		i = spi_flash_cmd(spi, CMD_M25PXX_RES, +				  idcode, 4); +		if (i) +			return NULL; +		if ((idcode[3] & 0xf0) == 0x10) { +			idcode[0] = 0x20; +			idcode[1] = 0x20; +			idcode[2] = idcode[3] + 1; +		} else +			return NULL; +	} +  	for (i = 0; i < ARRAY_SIZE(stmicro_spi_flash_table); i++) {  		params = &stmicro_spi_flash_table[i];  		if (params->idcode1 == idcode[2]) { @@ -344,8 +365,9 @@ struct spi_flash *spi_flash_probe_stmicro(struct spi_slave *spi, u8 * idcode)  	stm->flash.size = params->page_size * params->pages_per_sector  	    * params->nr_sectors; -	debug("SF: Detected %s with page size %u, total %u bytes\n", -	      params->name, params->page_size, stm->flash.size); +	printf("SF: Detected %s with page size %u, total ", +	       params->name, params->page_size); +	print_size(stm->flash.size, "\n");  	return &stm->flash;  }  |