1 // SPDX-License-Identifier: GPL-2.0-only
21 #include <linux/mtd/mtd.h>
22 #include <linux/mtd/partitions.h>
49 	struct mtd_info		mtd;  member
53 	const char		*name;  member
60 #define to_sst25l_flash(x) container_of(x, struct sst25l_flash, mtd)
83 	err = spi_sync(flash->spi, &m);  in sst25l_status()
97 	err = spi_write(flash->spi, command, 1);  in sst25l_write_enable()
102 	err = spi_write(flash->spi, command, 1);  in sst25l_write_enable()
108 	err = spi_write(flash->spi, command, 2);  in sst25l_write_enable()
117 			return -EROFS;  in sst25l_write_enable()
139 	return -ETIMEDOUT;  in sst25l_wait_till_ready()
155 	err = spi_write(flash->spi, command, 4);  in sst25l_erase_sector()
166 static int sst25l_erase(struct mtd_info *mtd, struct erase_info *instr)  in sst25l_erase()  argument
168 	struct sst25l_flash *flash = to_sst25l_flash(mtd);  in sst25l_erase()
173 	if ((uint32_t)instr->len % mtd->erasesize)  in sst25l_erase()
174 		return -EINVAL;  in sst25l_erase()
176 	if ((uint32_t)instr->addr % mtd->erasesize)  in sst25l_erase()
177 		return -EINVAL;  in sst25l_erase()
179 	addr = instr->addr;  in sst25l_erase()
180 	end = addr + instr->len;  in sst25l_erase()
182 	mutex_lock(&flash->lock);  in sst25l_erase()
186 		mutex_unlock(&flash->lock);  in sst25l_erase()
193 			mutex_unlock(&flash->lock);  in sst25l_erase()
194 			dev_err(&flash->spi->dev, "Erase failed\n");  in sst25l_erase()
198 		addr += mtd->erasesize;  in sst25l_erase()
201 	mutex_unlock(&flash->lock);  in sst25l_erase()
206 static int sst25l_read(struct mtd_info *mtd, loff_t from, size_t len,  in sst25l_read()  argument
209 	struct sst25l_flash *flash = to_sst25l_flash(mtd);  in sst25l_read()
231 	mutex_lock(&flash->lock);  in sst25l_read()
236 		mutex_unlock(&flash->lock);  in sst25l_read()
240 	spi_sync(flash->spi, &message);  in sst25l_read()
243 		*retlen += message.actual_length - sizeof(command);  in sst25l_read()
245 	mutex_unlock(&flash->lock);  in sst25l_read()
249 static int sst25l_write(struct mtd_info *mtd, loff_t to, size_t len,  in sst25l_write()  argument
252 	struct sst25l_flash *flash = to_sst25l_flash(mtd);  in sst25l_write()
256 	if ((uint32_t)to % mtd->writesize)  in sst25l_write()
257 		return -EINVAL;  in sst25l_write()
259 	mutex_lock(&flash->lock);  in sst25l_write()
265 	for (i = 0; i < len; i += mtd->writesize) {  in sst25l_write()
276 		ret = spi_write(flash->spi, command, 5);  in sst25l_write()
285 		bytes = min_t(uint32_t, mtd->writesize, len - i);  in sst25l_write()
292 			ret = spi_write(flash->spi, command, 2);  in sst25l_write()
304 	mutex_unlock(&flash->lock);  in sst25l_write()
332 		dev_err(&spi->dev, "error reading device id\n");  in sst25l_match_device()
343 		dev_err(&spi->dev, "unknown id %.4x\n", id);  in sst25l_match_device()
357 		return -ENODEV;  in sst25l_probe()
359 	flash = devm_kzalloc(&spi->dev, sizeof(*flash), GFP_KERNEL);  in sst25l_probe()
361 		return -ENOMEM;  in sst25l_probe()
363 	flash->spi = spi;  in sst25l_probe()
364 	mutex_init(&flash->lock);  in sst25l_probe()
367 	data = dev_get_platdata(&spi->dev);  in sst25l_probe()
368 	if (data && data->name)  in sst25l_probe()
369 		flash->mtd.name = data->name;  in sst25l_probe()
371 	flash->mtd.dev.parent   = &spi->dev;  in sst25l_probe()
372 	flash->mtd.type		= MTD_NORFLASH;  in sst25l_probe()
373 	flash->mtd.flags	= MTD_CAP_NORFLASH;  in sst25l_probe()
374 	flash->mtd.erasesize	= flash_info->erase_size;  in sst25l_probe()
375 	flash->mtd.writesize	= flash_info->page_size;  in sst25l_probe()
376 	flash->mtd.writebufsize	= flash_info->page_size;  in sst25l_probe()
377 	flash->mtd.size		= flash_info->page_size * flash_info->nr_pages;  in sst25l_probe()
378 	flash->mtd._erase	= sst25l_erase;  in sst25l_probe()
379 	flash->mtd._read		= sst25l_read;  in sst25l_probe()
380 	flash->mtd._write 	= sst25l_write;  in sst25l_probe()
382 	dev_info(&spi->dev, "%s (%lld KiB)\n", flash_info->name,  in sst25l_probe()
383 		 (long long)flash->mtd.size >> 10);  in sst25l_probe()
385 	pr_debug("mtd .name = %s, .size = 0x%llx (%lldMiB) "  in sst25l_probe()
387 	      flash->mtd.name,  in sst25l_probe()
388 	      (long long)flash->mtd.size, (long long)(flash->mtd.size >> 20),  in sst25l_probe()
389 	      flash->mtd.erasesize, flash->mtd.erasesize / 1024,  in sst25l_probe()
390 	      flash->mtd.numeraseregions);  in sst25l_probe()
393 	ret = mtd_device_register(&flash->mtd, data ? data->parts : NULL,  in sst25l_probe()
394 				  data ? data->nr_parts : 0);  in sst25l_probe()
396 		return -ENODEV;  in sst25l_probe()
405 	WARN_ON(mtd_device_unregister(&flash->mtd));  in sst25l_remove()
410 		.name	= "sst25l",
418 MODULE_DESCRIPTION("MTD SPI driver for SST25L Flash chips");