• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2012-2014 Daniel Schwierzeck, daniel.schwierzeck@gmail.com
4  */
5 
6 #include <common.h>
7 #include <malloc.h>
8 #include <linux/errno.h>
9 #include <linux/mtd/mtd.h>
10 #include <spi_flash.h>
11 
12 static struct mtd_info sf_mtd_info;
13 static char sf_mtd_name[8];
14 
spi_flash_mtd_erase(struct mtd_info * mtd,struct erase_info * instr)15 static int spi_flash_mtd_erase(struct mtd_info *mtd, struct erase_info *instr)
16 {
17 	struct spi_flash *flash = mtd->priv;
18 	int err;
19 
20 	instr->state = MTD_ERASING;
21 
22 	err = spi_flash_erase(flash, instr->addr, instr->len);
23 	if (err) {
24 		instr->state = MTD_ERASE_FAILED;
25 		instr->fail_addr = MTD_FAIL_ADDR_UNKNOWN;
26 		return -EIO;
27 	}
28 
29 	instr->state = MTD_ERASE_DONE;
30 	mtd_erase_callback(instr);
31 
32 	return 0;
33 }
34 
spi_flash_mtd_read(struct mtd_info * mtd,loff_t from,size_t len,size_t * retlen,u_char * buf)35 static int spi_flash_mtd_read(struct mtd_info *mtd, loff_t from, size_t len,
36 	size_t *retlen, u_char *buf)
37 {
38 	struct spi_flash *flash = mtd->priv;
39 	int err;
40 
41 	err = spi_flash_read(flash, from, len, buf);
42 	if (!err)
43 		*retlen = len;
44 
45 	return err;
46 }
47 
spi_flash_mtd_write(struct mtd_info * mtd,loff_t to,size_t len,size_t * retlen,const u_char * buf)48 static int spi_flash_mtd_write(struct mtd_info *mtd, loff_t to, size_t len,
49 	size_t *retlen, const u_char *buf)
50 {
51 	struct spi_flash *flash = mtd->priv;
52 	int err;
53 
54 	err = spi_flash_write(flash, to, len, buf);
55 	if (!err)
56 		*retlen = len;
57 
58 	return err;
59 }
60 
spi_flash_mtd_sync(struct mtd_info * mtd)61 static void spi_flash_mtd_sync(struct mtd_info *mtd)
62 {
63 }
64 
spi_flash_mtd_number(void)65 static int spi_flash_mtd_number(void)
66 {
67 #ifdef CONFIG_SYS_MAX_FLASH_BANKS
68 	return CONFIG_SYS_MAX_FLASH_BANKS;
69 #else
70 	return 0;
71 #endif
72 }
73 
spi_flash_mtd_register(struct spi_flash * flash)74 int spi_flash_mtd_register(struct spi_flash *flash)
75 {
76 	memset(&sf_mtd_info, 0, sizeof(sf_mtd_info));
77 	sprintf(sf_mtd_name, "nor%d", spi_flash_mtd_number());
78 
79 	sf_mtd_info.name = sf_mtd_name;
80 	sf_mtd_info.type = MTD_NORFLASH;
81 	sf_mtd_info.flags = MTD_CAP_NORFLASH;
82 	sf_mtd_info.writesize = 1;
83 	sf_mtd_info.writebufsize = flash->page_size;
84 
85 	sf_mtd_info._erase = spi_flash_mtd_erase;
86 	sf_mtd_info._read = spi_flash_mtd_read;
87 	sf_mtd_info._write = spi_flash_mtd_write;
88 	sf_mtd_info._sync = spi_flash_mtd_sync;
89 
90 	sf_mtd_info.size = flash->size;
91 	sf_mtd_info.priv = flash;
92 
93 	/* Only uniform flash devices for now */
94 	sf_mtd_info.numeraseregions = 0;
95 	sf_mtd_info.erasesize = flash->sector_size;
96 
97 	return add_mtd_device(&sf_mtd_info);
98 }
99 
spi_flash_mtd_unregister(void)100 void spi_flash_mtd_unregister(void)
101 {
102 	del_mtd_device(&sf_mtd_info);
103 }
104