diff options
Diffstat (limited to 'target/linux/bcm53xx')
| -rw-r--r-- | target/linux/bcm53xx/files/drivers/mtd/spi-nor/bcm53xxspiflash.c | 228 |
1 files changed, 0 insertions, 228 deletions
diff --git a/target/linux/bcm53xx/files/drivers/mtd/spi-nor/bcm53xxspiflash.c b/target/linux/bcm53xx/files/drivers/mtd/spi-nor/bcm53xxspiflash.c deleted file mode 100644 index 438fd49..0000000 --- a/target/linux/bcm53xx/files/drivers/mtd/spi-nor/bcm53xxspiflash.c +++ /dev/null @@ -1,228 +0,0 @@ -#include <linux/module.h> -#include <linux/delay.h> -#include <linux/spi/spi.h> -#include <linux/mtd/spi-nor.h> -#include <linux/mtd/mtd.h> -#include <linux/mtd/cfi.h> -#include <linux/mtd/partitions.h> - -static const char * const probes[] = { "ofpart", "bcm47xxpart", NULL }; - -struct bcm53xxsf { - struct spi_device *spi; - struct spi_nor nor; -}; - -/************************************************** - * spi-nor API - **************************************************/ - -static int bcm53xxspiflash_read_reg(struct spi_nor *nor, u8 opcode, u8 *buf, - int len) -{ - struct bcm53xxsf *b53sf = nor->priv; - - return spi_write_then_read(b53sf->spi, &opcode, 1, buf, len); -} - -static int bcm53xxspiflash_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf, - int len) -{ - struct bcm53xxsf *b53sf = nor->priv; - u8 *cmd = kzalloc(len + 1, GFP_KERNEL); - int err; - - if (!cmd) - return -ENOMEM; - - cmd[0] = opcode; - memcpy(&cmd[1], buf, len); - err = spi_write(b53sf->spi, cmd, len + 1); - - kfree(cmd); - - return err; -} - -static int bcm53xxspiflash_read(struct spi_nor *nor, loff_t from, size_t len, - size_t *retlen, u_char *buf) -{ - struct bcm53xxsf *b53sf = nor->priv; - struct spi_message m; - struct spi_transfer t[2] = { { 0 }, { 0 } }; - unsigned char cmd[5]; - int cmd_len = 0; - int err; - - spi_message_init(&m); - - cmd[cmd_len++] = SPINOR_OP_READ; - if (nor->mtd.size > 0x1000000) - cmd[cmd_len++] = (from & 0xFF000000) >> 24; - cmd[cmd_len++] = (from & 0x00FF0000) >> 16; - cmd[cmd_len++] = (from & 0x0000FF00) >> 8; - cmd[cmd_len++] = (from & 0x000000FF) >> 0; - - t[0].tx_buf = cmd; - t[0].len = cmd_len; - spi_message_add_tail(&t[0], &m); - - t[1].rx_buf = buf; - t[1].len = len; - spi_message_add_tail(&t[1], &m); - - err = spi_sync(b53sf->spi, &m); - if (err) - return err; - - if (retlen && m.actual_length > cmd_len) - *retlen = m.actual_length - cmd_len; - - return 0; -} - -static void bcm53xxspiflash_write(struct spi_nor *nor, loff_t to, size_t len, - size_t *retlen, const u_char *buf) -{ - struct bcm53xxsf *b53sf = nor->priv; - struct spi_message m; - struct spi_transfer t = { 0 }; - u8 *cmd = kzalloc(len + 5, GFP_KERNEL); - int cmd_len = 0; - int err; - - if (!cmd) - return; - - spi_message_init(&m); - - cmd[cmd_len++] = nor->program_opcode; - if (nor->mtd.size > 0x1000000) - cmd[cmd_len++] = (to & 0xFF000000) >> 24; - cmd[cmd_len++] = (to & 0x00FF0000) >> 16; - cmd[cmd_len++] = (to & 0x0000FF00) >> 8; - cmd[cmd_len++] = (to & 0x000000FF) >> 0; - memcpy(&cmd[cmd_len], buf, len); - - t.tx_buf = cmd; - t.len = cmd_len + len; - spi_message_add_tail(&t, &m); - - err = spi_sync(b53sf->spi, &m); - if (err) - goto out; - - if (retlen && m.actual_length > cmd_len) - *retlen += m.actual_length - cmd_len; - -out: - kfree(cmd); -} - -static int bcm53xxspiflash_erase(struct spi_nor *nor, loff_t offs) -{ - struct bcm53xxsf *b53sf = nor->priv; - unsigned char cmd[5]; - int i; - - i = 0; - cmd[i++] = nor->erase_opcode; - if (nor->mtd.size > 0x1000000) - cmd[i++] = (offs & 0xFF000000) >> 24; - cmd[i++] = ((offs & 0x00FF0000) >> 16); - cmd[i++] = ((offs & 0x0000FF00) >> 8); - cmd[i++] = ((offs & 0x000000FF) >> 0); - - return spi_write(b53sf->spi, cmd, i); -} - -static const char *bcm53xxspiflash_chip_name(struct spi_nor *nor) -{ - struct bcm53xxsf *b53sf = nor->priv; - struct device *dev = &b53sf->spi->dev; - unsigned char cmd[4]; - unsigned char resp[2]; - int err; - - /* SST and Winbond/NexFlash specific command */ - cmd[0] = 0x90; /* Read Manufacturer / Device ID */ - cmd[1] = 0; - cmd[2] = 0; - cmd[3] = 0; - err = spi_write_then_read(b53sf->spi, cmd, 4, resp, 2); - if (err < 0) { - dev_err(dev, "error reading SPI flash id\n"); - return ERR_PTR(-EBUSY); - } - switch (resp[0]) { - case 0xef: /* Winbond/NexFlash */ - switch (resp[1]) { - case 0x17: - return "w25q128"; - } - dev_err(dev, "Unknown Winbond/NexFlash flash: %02X %02X\n", - resp[0], resp[1]); - return NULL; - } - - /* TODO: Try more ID commands */ - - return NULL; -} - -/************************************************** - * SPI driver - **************************************************/ - -static int bcm53xxspiflash_probe(struct spi_device *spi) -{ - struct mtd_part_parser_data parser_data = {}; - struct bcm53xxsf *b53sf; - struct spi_nor *nor; - int err; - - b53sf = devm_kzalloc(&spi->dev, sizeof(*b53sf), GFP_KERNEL); - if (!b53sf) - return -ENOMEM; - spi_set_drvdata(spi, b53sf); - - nor = &b53sf->nor; - b53sf->spi = spi; - - nor->dev = &spi->dev; - nor->read_reg = bcm53xxspiflash_read_reg; - nor->write_reg = bcm53xxspiflash_write_reg; - nor->read = bcm53xxspiflash_read; - nor->write = bcm53xxspiflash_write; - nor->erase = bcm53xxspiflash_erase; - nor->priv = b53sf; - - err = spi_nor_scan(&b53sf->nor, bcm53xxspiflash_chip_name(nor), - SPI_NOR_NORMAL); - if (err) - return err; - - parser_data.of_node = spi->master->dev.parent->of_node; - err = mtd_device_parse_register(&nor->mtd, probes, &parser_data, - NULL, 0); - if (err) - return err; - - return 0; -} - -static int bcm53xxspiflash_remove(struct spi_device *spi) -{ - return 0; -} - -static struct spi_driver bcm53xxspiflash_driver = { - .driver = { - .name = "bcm53xxspiflash", - .owner = THIS_MODULE, - }, - .probe = bcm53xxspiflash_probe, - .remove = bcm53xxspiflash_remove, -}; - -module_spi_driver(bcm53xxspiflash_driver); |