M7350/kernel/drivers/mtd/devices/m25p80.c

334 lines
8.6 KiB
C
Raw Normal View History

2024-09-09 08:52:07 +00:00
/*
* MTD SPI driver for ST M25Pxx (and similar) serial flash chips
*
* Author: Mike Lavender, mike@steroidmicros.com
*
* Copyright (c) 2005, Intec Automation Inc.
*
* Some parts are based on lart.c by Abraham Van Der Merwe
*
* Cleaned up and generalized based on mtd_dataflash.c
*
* This code is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
*/
#include <linux/err.h>
#include <linux/errno.h>
#include <linux/module.h>
#include <linux/device.h>
2024-09-09 08:57:42 +00:00
2024-09-09 08:52:07 +00:00
#include <linux/mtd/mtd.h>
#include <linux/mtd/partitions.h>
#include <linux/spi/spi.h>
#include <linux/spi/flash.h>
2024-09-09 08:57:42 +00:00
#include <linux/mtd/spi-nor.h>
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
#define MAX_CMD_SIZE 6
2024-09-09 08:52:07 +00:00
struct m25p {
struct spi_device *spi;
2024-09-09 08:57:42 +00:00
struct spi_nor spi_nor;
2024-09-09 08:52:07 +00:00
struct mtd_info mtd;
2024-09-09 08:57:42 +00:00
u8 command[MAX_CMD_SIZE];
2024-09-09 08:52:07 +00:00
};
2024-09-09 08:57:42 +00:00
static int m25p80_read_reg(struct spi_nor *nor, u8 code, u8 *val, int len)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi;
int ret;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
ret = spi_write_then_read(spi, &code, 1, val, len);
if (ret < 0)
dev_err(&spi->dev, "error %d reading %x\n", ret, code);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
return ret;
2024-09-09 08:52:07 +00:00
}
2024-09-09 08:57:42 +00:00
static void m25p_addr2cmd(struct spi_nor *nor, unsigned int addr, u8 *cmd)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
/* opcode is in cmd[0] */
cmd[1] = addr >> (nor->addr_width * 8 - 8);
cmd[2] = addr >> (nor->addr_width * 8 - 16);
cmd[3] = addr >> (nor->addr_width * 8 - 24);
cmd[4] = addr >> (nor->addr_width * 8 - 32);
2024-09-09 08:52:07 +00:00
}
2024-09-09 08:57:42 +00:00
static int m25p_cmdsz(struct spi_nor *nor)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
return 1 + nor->addr_width;
2024-09-09 08:52:07 +00:00
}
2024-09-09 08:57:42 +00:00
static int m25p80_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf, int len,
int wr_en)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
flash->command[0] = opcode;
if (buf)
memcpy(&flash->command[1], buf, len);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
return spi_write(spi, flash->command, len + 1);
2024-09-09 08:52:07 +00:00
}
2024-09-09 08:57:42 +00:00
static void m25p80_write(struct spi_nor *nor, loff_t to, size_t len,
size_t *retlen, const u_char *buf)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi;
struct spi_transfer t[2] = {};
struct spi_message m;
int cmd_sz = m25p_cmdsz(nor);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
spi_message_init(&m);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
if (nor->program_opcode == SPINOR_OP_AAI_WP && nor->sst_write_second)
cmd_sz = 1;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
flash->command[0] = nor->program_opcode;
m25p_addr2cmd(nor, to, flash->command);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
t[0].tx_buf = flash->command;
t[0].len = cmd_sz;
spi_message_add_tail(&t[0], &m);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
t[1].tx_buf = buf;
t[1].len = len;
spi_message_add_tail(&t[1], &m);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
spi_sync(spi, &m);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
*retlen += m.actual_length - cmd_sz;
2024-09-09 08:52:07 +00:00
}
2024-09-09 08:57:42 +00:00
static inline unsigned int m25p80_rx_nbits(struct spi_nor *nor)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
switch (nor->flash_read) {
case SPI_NOR_DUAL:
return 2;
case SPI_NOR_QUAD:
return 4;
default:
return 0;
2024-09-09 08:52:07 +00:00
}
}
/*
2024-09-09 08:57:42 +00:00
* Read an address range from the nor chip. The address range
2024-09-09 08:52:07 +00:00
* may be any size provided it is within the physical boundaries.
*/
2024-09-09 08:57:42 +00:00
static int m25p80_read(struct spi_nor *nor, loff_t from, size_t len,
size_t *retlen, u_char *buf)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi;
2024-09-09 08:52:07 +00:00
struct spi_transfer t[2];
struct spi_message m;
2024-09-09 08:57:42 +00:00
int dummy = nor->read_dummy;
int ret;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
/* Wait till previous write/erase is done. */
ret = nor->wait_till_ready(nor);
if (ret)
return ret;
2024-09-09 08:52:07 +00:00
spi_message_init(&m);
memset(t, 0, (sizeof t));
2024-09-09 08:57:42 +00:00
flash->command[0] = nor->read_opcode;
m25p_addr2cmd(nor, from, flash->command);
2024-09-09 08:52:07 +00:00
t[0].tx_buf = flash->command;
2024-09-09 08:57:42 +00:00
t[0].len = m25p_cmdsz(nor) + dummy;
2024-09-09 08:52:07 +00:00
spi_message_add_tail(&t[0], &m);
t[1].rx_buf = buf;
2024-09-09 08:57:42 +00:00
t[1].rx_nbits = m25p80_rx_nbits(nor);
2024-09-09 08:52:07 +00:00
t[1].len = len;
spi_message_add_tail(&t[1], &m);
2024-09-09 08:57:42 +00:00
spi_sync(spi, &m);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
*retlen = m.actual_length - m25p_cmdsz(nor) - dummy;
2024-09-09 08:52:07 +00:00
return 0;
}
2024-09-09 08:57:42 +00:00
static int m25p80_erase(struct spi_nor *nor, loff_t offset)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
struct m25p *flash = nor->priv;
int ret;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
dev_dbg(nor->dev, "%dKiB at 0x%08x\n",
flash->mtd.erasesize / 1024, (u32)offset);
2024-09-09 08:52:07 +00:00
/* Wait until finished previous write command. */
2024-09-09 08:57:42 +00:00
ret = nor->wait_till_ready(nor);
2024-09-09 08:52:07 +00:00
if (ret)
2024-09-09 08:57:42 +00:00
return ret;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
/* Send write enable, then erase commands. */
ret = nor->write_reg(nor, SPINOR_OP_WREN, NULL, 0, 0);
if (ret)
return ret;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
/* Set up command buffer. */
flash->command[0] = nor->erase_opcode;
m25p_addr2cmd(nor, offset, flash->command);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
spi_write(flash->spi, flash->command, m25p_cmdsz(nor));
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
return 0;
2024-09-09 08:52:07 +00:00
}
/*
* board specific setup should have ensured the SPI clock used here
* matches what the READ command supports, at least until this driver
* understands FAST_READ (for clocks over 25 MHz).
*/
2024-09-09 08:57:42 +00:00
static int m25p_probe(struct spi_device *spi)
2024-09-09 08:52:07 +00:00
{
struct mtd_part_parser_data ppdata;
2024-09-09 08:57:42 +00:00
struct flash_platform_data *data;
struct m25p *flash;
struct spi_nor *nor;
enum read_mode mode = SPI_NOR_NORMAL;
char *flash_name = NULL;
int ret;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
data = dev_get_platdata(&spi->dev);
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
flash = devm_kzalloc(&spi->dev, sizeof(*flash), GFP_KERNEL);
2024-09-09 08:52:07 +00:00
if (!flash)
return -ENOMEM;
2024-09-09 08:57:42 +00:00
nor = &flash->spi_nor;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
/* install the hooks */
nor->read = m25p80_read;
nor->write = m25p80_write;
nor->erase = m25p80_erase;
nor->write_reg = m25p80_write_reg;
nor->read_reg = m25p80_read_reg;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
nor->dev = &spi->dev;
nor->mtd = &flash->mtd;
nor->priv = flash;
spi_set_drvdata(spi, flash);
flash->mtd.priv = nor;
flash->spi = spi;
if (spi->mode & SPI_RX_QUAD)
mode = SPI_NOR_QUAD;
else if (spi->mode & SPI_RX_DUAL)
mode = SPI_NOR_DUAL;
2024-09-09 08:52:07 +00:00
if (data && data->name)
flash->mtd.name = data->name;
2024-09-09 08:57:42 +00:00
/* For some (historical?) reason many platforms provide two different
* names in flash_platform_data: "name" and "type". Quite often name is
* set to "m25p80" and then "type" provides a real chip name.
* If that's the case, respect "type" and ignore a "name".
*/
if (data && data->type)
flash_name = data->type;
2024-09-09 08:52:07 +00:00
else
2024-09-09 08:57:42 +00:00
flash_name = spi->modalias;
2024-09-09 08:52:07 +00:00
2024-09-09 08:57:42 +00:00
ret = spi_nor_scan(nor, flash_name, mode);
if (ret)
return ret;
2024-09-09 08:52:07 +00:00
ppdata.of_node = spi->dev.of_node;
return mtd_device_parse_register(&flash->mtd, NULL, &ppdata,
data ? data->parts : NULL,
data ? data->nr_parts : 0);
}
2024-09-09 08:57:42 +00:00
static int m25p_remove(struct spi_device *spi)
2024-09-09 08:52:07 +00:00
{
2024-09-09 08:57:42 +00:00
struct m25p *flash = spi_get_drvdata(spi);
2024-09-09 08:52:07 +00:00
/* Clean up MTD stuff. */
2024-09-09 08:57:42 +00:00
return mtd_device_unregister(&flash->mtd);
2024-09-09 08:52:07 +00:00
}
2024-09-09 08:57:42 +00:00
/*
* XXX This needs to be kept in sync with spi_nor_ids. We can't share
* it with spi-nor, because if this is built as a module then modpost
* won't be able to read it and add appropriate aliases.
*/
static const struct spi_device_id m25p_ids[] = {
{"at25fs010"}, {"at25fs040"}, {"at25df041a"}, {"at25df321a"},
{"at25df641"}, {"at26f004"}, {"at26df081a"}, {"at26df161a"},
{"at26df321"}, {"at45db081d"},
{"en25f32"}, {"en25p32"}, {"en25q32b"}, {"en25p64"},
{"en25q64"}, {"en25qh128"}, {"en25qh256"},
{"f25l32pa"},
{"mr25h256"}, {"mr25h10"},
{"gd25q32"}, {"gd25q64"},
{"160s33b"}, {"320s33b"}, {"640s33b"},
{"mx25l2005a"}, {"mx25l4005a"}, {"mx25l8005"}, {"mx25l1606e"},
{"mx25l3205d"}, {"mx25l3255e"}, {"mx25l6405d"}, {"mx25l12805d"},
{"mx25l12855e"},{"mx25l25635e"},{"mx25l25655e"},{"mx66l51235l"},
{"mx66l1g55g"},
{"n25q064"}, {"n25q128a11"}, {"n25q128a13"}, {"n25q256a"},
{"n25q512a"}, {"n25q512ax3"}, {"n25q00"},
{"pm25lv512"}, {"pm25lv010"}, {"pm25lq032"},
{"s25sl032p"}, {"s25sl064p"}, {"s25fl256s0"}, {"s25fl256s1"},
{"s25fl512s"}, {"s70fl01gs"}, {"s25sl12800"}, {"s25sl12801"},
{"s25fl129p0"}, {"s25fl129p1"}, {"s25sl004a"}, {"s25sl008a"},
{"s25sl016a"}, {"s25sl032a"}, {"s25sl064a"}, {"s25fl008k"},
{"s25fl016k"}, {"s25fl064k"},
{"sst25vf040b"},{"sst25vf080b"},{"sst25vf016b"},{"sst25vf032b"},
{"sst25vf064c"},{"sst25wf512"}, {"sst25wf010"}, {"sst25wf020"},
{"sst25wf040"},
{"m25p05"}, {"m25p10"}, {"m25p20"}, {"m25p40"},
{"m25p80"}, {"m25p16"}, {"m25p32"}, {"m25p64"},
{"m25p128"}, {"n25q032"},
{"m25p05-nonjedec"}, {"m25p10-nonjedec"}, {"m25p20-nonjedec"},
{"m25p40-nonjedec"}, {"m25p80-nonjedec"}, {"m25p16-nonjedec"},
{"m25p32-nonjedec"}, {"m25p64-nonjedec"}, {"m25p128-nonjedec"},
{"m45pe10"}, {"m45pe80"}, {"m45pe16"},
{"m25pe20"}, {"m25pe80"}, {"m25pe16"},
{"m25px16"}, {"m25px32"}, {"m25px32-s0"}, {"m25px32-s1"},
{"m25px64"}, {"m25px80"},
{"w25x10"}, {"w25x20"}, {"w25x40"}, {"w25x80"},
{"w25x16"}, {"w25x32"}, {"w25q32"}, {"w25q32dw"},
{"w25x64"}, {"w25q64"}, {"w25q80"}, {"w25q80bl"},
{"w25q128"}, {"w25q256"}, {"cat25c11"},
{"cat25c03"}, {"cat25c09"}, {"cat25c17"}, {"cat25128"},
{ },
};
MODULE_DEVICE_TABLE(spi, m25p_ids);
2024-09-09 08:52:07 +00:00
static struct spi_driver m25p80_driver = {
.driver = {
.name = "m25p80",
.owner = THIS_MODULE,
},
.id_table = m25p_ids,
.probe = m25p_probe,
2024-09-09 08:57:42 +00:00
.remove = m25p_remove,
2024-09-09 08:52:07 +00:00
/* REVISIT: many of these chips have deep power-down modes, which
* should clearly be entered on suspend() to minimize power use.
* And also when they're otherwise idle...
*/
};
module_spi_driver(m25p80_driver);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Mike Lavender");
MODULE_DESCRIPTION("MTD SPI driver for ST M25Pxx flash chips");