未验证 提交 4120f8d1 编写于 作者: B Boris Brezillon 提交者: Mark Brown

mtd: spi-nor: Use the spi_mem_xx() API

The spi_mem_xxx() API has been introduced to replace the
spi_flash_read() one. Make use of it so we can get rid of
spi_flash_read().

Note that using spi_mem_xx() also simplifies the code because this API
takes care of using the regular spi_sync() interface when the optimized
->mem_ops interface is not implemented by the controller.
Signed-off-by: NBoris Brezillon <boris.brezillon@bootlin.com>
Reviewed-by: NFrieder Schrempf <frieder.schrempf@exceet.de>
Tested-by: NFrieder Schrempf <frieder.schrempf@exceet.de>
Signed-off-by: NMark Brown <broonie@kernel.org>
上级 b95cb394
...@@ -81,6 +81,7 @@ config MTD_DATAFLASH_OTP ...@@ -81,6 +81,7 @@ config MTD_DATAFLASH_OTP
config MTD_M25P80 config MTD_M25P80
tristate "Support most SPI Flash chips (AT26DF, M25P, W25X, ...)" tristate "Support most SPI Flash chips (AT26DF, M25P, W25X, ...)"
depends on SPI_MASTER && MTD_SPI_NOR depends on SPI_MASTER && MTD_SPI_NOR
select SPI_MEM
help help
This enables access to most modern SPI flash chips, used for This enables access to most modern SPI flash chips, used for
program and data storage. Series supported include Atmel AT26DF, program and data storage. Series supported include Atmel AT26DF,
......
...@@ -24,12 +24,13 @@ ...@@ -24,12 +24,13 @@
#include <linux/mtd/partitions.h> #include <linux/mtd/partitions.h>
#include <linux/spi/spi.h> #include <linux/spi/spi.h>
#include <linux/spi/spi-mem.h>
#include <linux/spi/flash.h> #include <linux/spi/flash.h>
#include <linux/mtd/spi-nor.h> #include <linux/mtd/spi-nor.h>
#define MAX_CMD_SIZE 6 #define MAX_CMD_SIZE 6
struct m25p { struct m25p {
struct spi_device *spi; struct spi_mem *spimem;
struct spi_nor spi_nor; struct spi_nor spi_nor;
u8 command[MAX_CMD_SIZE]; u8 command[MAX_CMD_SIZE];
}; };
...@@ -37,97 +38,68 @@ struct m25p { ...@@ -37,97 +38,68 @@ struct m25p {
static int m25p80_read_reg(struct spi_nor *nor, u8 code, u8 *val, int len) static int m25p80_read_reg(struct spi_nor *nor, u8 code, u8 *val, int len)
{ {
struct m25p *flash = nor->priv; struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi; struct spi_mem_op op = SPI_MEM_OP(SPI_MEM_OP_CMD(code, 1),
SPI_MEM_OP_NO_ADDR,
SPI_MEM_OP_NO_DUMMY,
SPI_MEM_OP_DATA_IN(len, val, 1));
int ret; int ret;
ret = spi_write_then_read(spi, &code, 1, val, len); ret = spi_mem_exec_op(flash->spimem, &op);
if (ret < 0) if (ret < 0)
dev_err(&spi->dev, "error %d reading %x\n", ret, code); dev_err(&flash->spimem->spi->dev, "error %d reading %x\n", ret,
code);
return ret; return ret;
} }
static void m25p_addr2cmd(struct spi_nor *nor, unsigned int addr, u8 *cmd)
{
/* 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);
}
static int m25p_cmdsz(struct spi_nor *nor)
{
return 1 + nor->addr_width;
}
static int m25p80_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf, int len) static int m25p80_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf, int len)
{ {
struct m25p *flash = nor->priv; struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi; struct spi_mem_op op = SPI_MEM_OP(SPI_MEM_OP_CMD(opcode, 1),
SPI_MEM_OP_NO_ADDR,
flash->command[0] = opcode; SPI_MEM_OP_NO_DUMMY,
if (buf) SPI_MEM_OP_DATA_OUT(len, buf, 1));
memcpy(&flash->command[1], buf, len);
return spi_write(spi, flash->command, len + 1); return spi_mem_exec_op(flash->spimem, &op);
} }
static ssize_t m25p80_write(struct spi_nor *nor, loff_t to, size_t len, static ssize_t m25p80_write(struct spi_nor *nor, loff_t to, size_t len,
const u_char *buf) const u_char *buf)
{ {
struct m25p *flash = nor->priv; struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi; struct spi_mem_op op =
unsigned int inst_nbits, addr_nbits, data_nbits, data_idx; SPI_MEM_OP(SPI_MEM_OP_CMD(nor->program_opcode, 1),
struct spi_transfer t[3] = {}; SPI_MEM_OP_ADDR(nor->addr_width, to, 1),
struct spi_message m; SPI_MEM_OP_DUMMY(0, 1),
int cmd_sz = m25p_cmdsz(nor); SPI_MEM_OP_DATA_OUT(len, buf, 1));
ssize_t ret; size_t remaining = len;
int ret;
/* get transfer protocols. */ /* get transfer protocols. */
inst_nbits = spi_nor_get_protocol_inst_nbits(nor->write_proto); op.cmd.buswidth = spi_nor_get_protocol_inst_nbits(nor->write_proto);
addr_nbits = spi_nor_get_protocol_addr_nbits(nor->write_proto); op.addr.buswidth = spi_nor_get_protocol_addr_nbits(nor->write_proto);
data_nbits = spi_nor_get_protocol_data_nbits(nor->write_proto); op.dummy.buswidth = op.addr.buswidth;
op.data.buswidth = spi_nor_get_protocol_data_nbits(nor->write_proto);
spi_message_init(&m);
if (nor->program_opcode == SPINOR_OP_AAI_WP && nor->sst_write_second) if (nor->program_opcode == SPINOR_OP_AAI_WP && nor->sst_write_second)
cmd_sz = 1; op.addr.nbytes = 0;
flash->command[0] = nor->program_opcode;
m25p_addr2cmd(nor, to, flash->command);
t[0].tx_buf = flash->command; while (remaining) {
t[0].tx_nbits = inst_nbits; op.data.nbytes = remaining < UINT_MAX ? remaining : UINT_MAX;
t[0].len = cmd_sz; ret = spi_mem_adjust_op_size(flash->spimem, &op);
spi_message_add_tail(&t[0], &m); if (ret)
return ret;
/* split the op code and address bytes into two transfers if needed. */
data_idx = 1;
if (addr_nbits != inst_nbits) {
t[0].len = 1;
t[1].tx_buf = &flash->command[1]; ret = spi_mem_exec_op(flash->spimem, &op);
t[1].tx_nbits = addr_nbits; if (ret)
t[1].len = cmd_sz - 1; return ret;
spi_message_add_tail(&t[1], &m);
data_idx = 2; op.addr.val += op.data.nbytes;
remaining -= op.data.nbytes;
op.data.buf.out += op.data.nbytes;
} }
t[data_idx].tx_buf = buf; return len;
t[data_idx].tx_nbits = data_nbits;
t[data_idx].len = len;
spi_message_add_tail(&t[data_idx], &m);
ret = spi_sync(spi, &m);
if (ret)
return ret;
ret = m.actual_length - cmd_sz;
if (ret < 0)
return -EIO;
return ret;
} }
/* /*
...@@ -138,92 +110,39 @@ static ssize_t m25p80_read(struct spi_nor *nor, loff_t from, size_t len, ...@@ -138,92 +110,39 @@ static ssize_t m25p80_read(struct spi_nor *nor, loff_t from, size_t len,
u_char *buf) u_char *buf)
{ {
struct m25p *flash = nor->priv; struct m25p *flash = nor->priv;
struct spi_device *spi = flash->spi; struct spi_mem_op op =
unsigned int inst_nbits, addr_nbits, data_nbits, data_idx; SPI_MEM_OP(SPI_MEM_OP_CMD(nor->read_opcode, 1),
struct spi_transfer t[3]; SPI_MEM_OP_ADDR(nor->addr_width, from, 1),
struct spi_message m; SPI_MEM_OP_DUMMY(nor->read_dummy, 1),
unsigned int dummy = nor->read_dummy; SPI_MEM_OP_DATA_IN(len, buf, 1));
ssize_t ret; size_t remaining = len;
int cmd_sz; int ret;
/* get transfer protocols. */ /* get transfer protocols. */
inst_nbits = spi_nor_get_protocol_inst_nbits(nor->read_proto); op.cmd.buswidth = spi_nor_get_protocol_inst_nbits(nor->read_proto);
addr_nbits = spi_nor_get_protocol_addr_nbits(nor->read_proto); op.addr.buswidth = spi_nor_get_protocol_addr_nbits(nor->read_proto);
data_nbits = spi_nor_get_protocol_data_nbits(nor->read_proto); op.dummy.buswidth = op.addr.buswidth;
op.data.buswidth = spi_nor_get_protocol_data_nbits(nor->read_proto);
/* convert the dummy cycles to the number of bytes */ /* convert the dummy cycles to the number of bytes */
dummy = (dummy * addr_nbits) / 8; op.dummy.nbytes = (nor->read_dummy * op.dummy.buswidth) / 8;
if (spi_flash_read_supported(spi)) {
struct spi_flash_read_message msg;
memset(&msg, 0, sizeof(msg));
msg.buf = buf; while (remaining) {
msg.from = from; op.data.nbytes = remaining < UINT_MAX ? remaining : UINT_MAX;
msg.len = len; ret = spi_mem_adjust_op_size(flash->spimem, &op);
msg.read_opcode = nor->read_opcode; if (ret)
msg.addr_width = nor->addr_width;
msg.dummy_bytes = dummy;
msg.opcode_nbits = inst_nbits;
msg.addr_nbits = addr_nbits;
msg.data_nbits = data_nbits;
ret = spi_flash_read(spi, &msg);
if (ret < 0)
return ret; return ret;
return msg.retlen;
}
spi_message_init(&m); ret = spi_mem_exec_op(flash->spimem, &op);
memset(t, 0, (sizeof t)); if (ret)
return ret;
flash->command[0] = nor->read_opcode;
m25p_addr2cmd(nor, from, flash->command);
t[0].tx_buf = flash->command;
t[0].tx_nbits = inst_nbits;
t[0].len = m25p_cmdsz(nor) + dummy;
spi_message_add_tail(&t[0], &m);
/*
* Set all dummy/mode cycle bits to avoid sending some manufacturer
* specific pattern, which might make the memory enter its Continuous
* Read mode by mistake.
* Based on the different mode cycle bit patterns listed and described
* in the JESD216B specification, the 0xff value works for all memories
* and all manufacturers.
*/
cmd_sz = t[0].len;
memset(flash->command + cmd_sz - dummy, 0xff, dummy);
/* split the op code and address bytes into two transfers if needed. */
data_idx = 1;
if (addr_nbits != inst_nbits) {
t[0].len = 1;
t[1].tx_buf = &flash->command[1];
t[1].tx_nbits = addr_nbits;
t[1].len = cmd_sz - 1;
spi_message_add_tail(&t[1], &m);
data_idx = 2; op.addr.val += op.data.nbytes;
remaining -= op.data.nbytes;
op.data.buf.in += op.data.nbytes;
} }
t[data_idx].rx_buf = buf; return len;
t[data_idx].rx_nbits = data_nbits;
t[data_idx].len = min3(len, spi_max_transfer_size(spi),
spi_max_message_size(spi) - cmd_sz);
spi_message_add_tail(&t[data_idx], &m);
ret = spi_sync(spi, &m);
if (ret)
return ret;
ret = m.actual_length - cmd_sz;
if (ret < 0)
return -EIO;
return ret;
} }
/* /*
...@@ -231,8 +150,9 @@ static ssize_t m25p80_read(struct spi_nor *nor, loff_t from, size_t len, ...@@ -231,8 +150,9 @@ static ssize_t m25p80_read(struct spi_nor *nor, loff_t from, size_t len,
* matches what the READ command supports, at least until this driver * matches what the READ command supports, at least until this driver
* understands FAST_READ (for clocks over 25 MHz). * understands FAST_READ (for clocks over 25 MHz).
*/ */
static int m25p_probe(struct spi_device *spi) static int m25p_probe(struct spi_mem *spimem)
{ {
struct spi_device *spi = spimem->spi;
struct flash_platform_data *data; struct flash_platform_data *data;
struct m25p *flash; struct m25p *flash;
struct spi_nor *nor; struct spi_nor *nor;
...@@ -244,9 +164,9 @@ static int m25p_probe(struct spi_device *spi) ...@@ -244,9 +164,9 @@ static int m25p_probe(struct spi_device *spi)
char *flash_name; char *flash_name;
int ret; int ret;
data = dev_get_platdata(&spi->dev); data = dev_get_platdata(&spimem->spi->dev);
flash = devm_kzalloc(&spi->dev, sizeof(*flash), GFP_KERNEL); flash = devm_kzalloc(&spimem->spi->dev, sizeof(*flash), GFP_KERNEL);
if (!flash) if (!flash)
return -ENOMEM; return -ENOMEM;
...@@ -258,12 +178,12 @@ static int m25p_probe(struct spi_device *spi) ...@@ -258,12 +178,12 @@ static int m25p_probe(struct spi_device *spi)
nor->write_reg = m25p80_write_reg; nor->write_reg = m25p80_write_reg;
nor->read_reg = m25p80_read_reg; nor->read_reg = m25p80_read_reg;
nor->dev = &spi->dev; nor->dev = &spimem->spi->dev;
spi_nor_set_flash_node(nor, spi->dev.of_node); spi_nor_set_flash_node(nor, spi->dev.of_node);
nor->priv = flash; nor->priv = flash;
spi_set_drvdata(spi, flash); spi_set_drvdata(spi, flash);
flash->spi = spi; flash->spimem = spimem;
if (spi->mode & SPI_RX_QUAD) { if (spi->mode & SPI_RX_QUAD) {
hwcaps.mask |= SNOR_HWCAPS_READ_1_1_4; hwcaps.mask |= SNOR_HWCAPS_READ_1_1_4;
...@@ -303,9 +223,9 @@ static int m25p_probe(struct spi_device *spi) ...@@ -303,9 +223,9 @@ static int m25p_probe(struct spi_device *spi)
} }
static int m25p_remove(struct spi_device *spi) static int m25p_remove(struct spi_mem *spimem)
{ {
struct m25p *flash = spi_get_drvdata(spi); struct m25p *flash = spi_mem_get_drvdata(spimem);
spi_nor_restore(&flash->spi_nor); spi_nor_restore(&flash->spi_nor);
...@@ -313,9 +233,9 @@ static int m25p_remove(struct spi_device *spi) ...@@ -313,9 +233,9 @@ static int m25p_remove(struct spi_device *spi)
return mtd_device_unregister(&flash->spi_nor.mtd); return mtd_device_unregister(&flash->spi_nor.mtd);
} }
static void m25p_shutdown(struct spi_device *spi) static void m25p_shutdown(struct spi_mem *spimem)
{ {
struct m25p *flash = spi_get_drvdata(spi); struct m25p *flash = spi_mem_get_drvdata(spimem);
spi_nor_restore(&flash->spi_nor); spi_nor_restore(&flash->spi_nor);
} }
...@@ -386,12 +306,14 @@ static const struct of_device_id m25p_of_table[] = { ...@@ -386,12 +306,14 @@ static const struct of_device_id m25p_of_table[] = {
}; };
MODULE_DEVICE_TABLE(of, m25p_of_table); MODULE_DEVICE_TABLE(of, m25p_of_table);
static struct spi_driver m25p80_driver = { static struct spi_mem_driver m25p80_driver = {
.driver = { .spidrv = {
.name = "m25p80", .driver = {
.of_match_table = m25p_of_table, .name = "m25p80",
.of_match_table = m25p_of_table,
},
.id_table = m25p_ids,
}, },
.id_table = m25p_ids,
.probe = m25p_probe, .probe = m25p_probe,
.remove = m25p_remove, .remove = m25p_remove,
.shutdown = m25p_shutdown, .shutdown = m25p_shutdown,
...@@ -402,7 +324,7 @@ static struct spi_driver m25p80_driver = { ...@@ -402,7 +324,7 @@ static struct spi_driver m25p80_driver = {
*/ */
}; };
module_spi_driver(m25p80_driver); module_spi_mem_driver(m25p80_driver);
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
MODULE_AUTHOR("Mike Lavender"); MODULE_AUTHOR("Mike Lavender");
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册