23 #include <linux/spi/flash.h>
62 static int mchp48l640_mkcmd(struct mchp48l640_flash *flash, u8 cmd, loff_t addr, char *buf)  in mchp48l640_mkcmd()  argument
71 static int mchp48l640_read_status(struct mchp48l640_flash *flash, int *status)  in mchp48l640_read_status()  argument
78 	mutex_lock(&flash->lock);  in mchp48l640_read_status()
79 	ret = spi_write_then_read(flash->spi, &cmd[0], 1, &cmd[1], 1);  in mchp48l640_read_status()
80 	mutex_unlock(&flash->lock);  in mchp48l640_read_status()
83 	dev_dbg(&flash->spi->dev, "read status ret: %d status: %x", ret, *status);  in mchp48l640_read_status()
88 static int mchp48l640_waitforbit(struct mchp48l640_flash *flash, int bit, bool set)  in mchp48l640_waitforbit()  argument
95 		ret = mchp48l640_read_status(flash, &status);  in mchp48l640_waitforbit()
96 		dev_dbg(&flash->spi->dev, "read status ret: %d bit: %x %sset status: %x",  in mchp48l640_waitforbit()
112 	dev_err(&flash->spi->dev, "Timeout waiting for bit %x %s set in status register.",  in mchp48l640_waitforbit()
117 static int mchp48l640_write_prepare(struct mchp48l640_flash *flash, bool enable)  in mchp48l640_write_prepare()  argument
127 	mutex_lock(&flash->lock);  in mchp48l640_write_prepare()
128 	ret = spi_write(flash->spi, cmd, 1);  in mchp48l640_write_prepare()
129 	mutex_unlock(&flash->lock);  in mchp48l640_write_prepare()
132 		dev_err(&flash->spi->dev, "write %s failed ret: %d",  in mchp48l640_write_prepare()
135 	dev_dbg(&flash->spi->dev, "write %s success ret: %d",  in mchp48l640_write_prepare()
138 		return mchp48l640_waitforbit(flash, MCHP48L640_STATUS_WEL, true);  in mchp48l640_write_prepare()
143 static int mchp48l640_set_mode(struct mchp48l640_flash *flash)  in mchp48l640_set_mode()  argument
148 	ret = mchp48l640_write_prepare(flash, true);  in mchp48l640_set_mode()
155 	mutex_lock(&flash->lock);  in mchp48l640_set_mode()
156 	ret = spi_write(flash->spi, cmd, 2);  in mchp48l640_set_mode()
157 	mutex_unlock(&flash->lock);  in mchp48l640_set_mode()
159 		dev_err(&flash->spi->dev, "Could not set continuous mode ret: %d", ret);  in mchp48l640_set_mode()
161 	return mchp48l640_waitforbit(flash, MCHP48L640_STATUS_PRO, true);  in mchp48l640_set_mode()
164 static int mchp48l640_wait_rdy(struct mchp48l640_flash *flash)  in mchp48l640_wait_rdy()  argument
166 	return mchp48l640_waitforbit(flash, MCHP48L640_STATUS_RDY, false);  in mchp48l640_wait_rdy()
172 	struct mchp48l640_flash *flash = to_mchp48l640_flash(mtd);  in mchp48l640_write_page()  local
181 	ret = mchp48l640_wait_rdy(flash);  in mchp48l640_write_page()
185 	ret = mchp48l640_write_prepare(flash, true);  in mchp48l640_write_page()
189 	mutex_lock(&flash->lock);  in mchp48l640_write_page()
190 	cmdlen = mchp48l640_mkcmd(flash, MCHP48L640_CMD_WRITE, to, cmd);  in mchp48l640_write_page()
192 	ret = spi_write(flash->spi, cmd, cmdlen + len);  in mchp48l640_write_page()
193 	mutex_unlock(&flash->lock);  in mchp48l640_write_page()
199 	if (flash->caps->auto_disable_wel) {  in mchp48l640_write_page()
200 		ret = mchp48l640_waitforbit(flash, MCHP48L640_STATUS_WEL, false);  in mchp48l640_write_page()
204 		ret = mchp48l640_write_prepare(flash, false);  in mchp48l640_write_page()
213 	dev_err(&flash->spi->dev, "write fail with: %d", ret);  in mchp48l640_write_page()
220 	struct mchp48l640_flash *flash = to_mchp48l640_flash(mtd);  in mchp48l640_write()  local
225 	size_t page_sz = flash->caps->page_size;  in mchp48l640_write()
246 	struct mchp48l640_flash *flash = to_mchp48l640_flash(mtd);  in mchp48l640_read_page()  local
255 	ret = mchp48l640_wait_rdy(flash);  in mchp48l640_read_page()
259 	mutex_lock(&flash->lock);  in mchp48l640_read_page()
260 	cmdlen = mchp48l640_mkcmd(flash, MCHP48L640_CMD_READ, from, cmd);  in mchp48l640_read_page()
261 	ret = spi_write_then_read(flash->spi, cmd, cmdlen, buf, len);  in mchp48l640_read_page()
262 	mutex_unlock(&flash->lock);  in mchp48l640_read_page()
271 	dev_err(&flash->spi->dev, "read fail with: %d", ret);  in mchp48l640_read_page()
278 	struct mchp48l640_flash *flash = to_mchp48l640_flash(mtd);  in mchp48l640_read()  local
283 	size_t page_sz = flash->caps->page_size;  in mchp48l640_read()
315 	struct mchp48l640_flash *flash;  in mchp48l640_probe()  local
320 	flash = devm_kzalloc(&spi->dev, sizeof(*flash), GFP_KERNEL);  in mchp48l640_probe()
321 	if (!flash)  in mchp48l640_probe()
324 	flash->spi = spi;  in mchp48l640_probe()
325 	mutex_init(&flash->lock);  in mchp48l640_probe()
326 	spi_set_drvdata(spi, flash);  in mchp48l640_probe()
328 	err = mchp48l640_read_status(flash, &status);  in mchp48l640_probe()
332 	err = mchp48l640_set_mode(flash);  in mchp48l640_probe()
338 	flash->caps = of_device_get_match_data(&spi->dev);  in mchp48l640_probe()
339 	if (!flash->caps)  in mchp48l640_probe()
340 		flash->caps = &mchp48l640_caps;  in mchp48l640_probe()
342 	mtd_set_of_node(&flash->mtd, spi->dev.of_node);  in mchp48l640_probe()
343 	flash->mtd.dev.parent	= &spi->dev;  in mchp48l640_probe()
344 	flash->mtd.type		= MTD_RAM;  in mchp48l640_probe()
345 	flash->mtd.flags	= MTD_CAP_RAM;  in mchp48l640_probe()
346 	flash->mtd.writesize	= flash->caps->page_size;  in mchp48l640_probe()
347 	flash->mtd.size		= flash->caps->size;  in mchp48l640_probe()
348 	flash->mtd._read	= mchp48l640_read;  in mchp48l640_probe()
349 	flash->mtd._write	= mchp48l640_write;  in mchp48l640_probe()
351 	err = mtd_device_register(&flash->mtd, data ? data->parts : NULL,  in mchp48l640_probe()
361 	struct mchp48l640_flash *flash = spi_get_drvdata(spi);  in mchp48l640_remove()  local
363 	WARN_ON(mtd_device_unregister(&flash->mtd));  in mchp48l640_remove()