1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30#include <common.h>
31#include <malloc.h>
32#include <spi_flash.h>
33
34#include "spi_flash_internal.h"
35
36
37#define CMD_M25PXX_WREN 0x06
38#define CMD_M25PXX_WRDI 0x04
39#define CMD_M25PXX_RDSR 0x05
40#define CMD_M25PXX_WRSR 0x01
41#define CMD_M25PXX_READ 0x03
42#define CMD_M25PXX_FAST_READ 0x0b
43#define CMD_M25PXX_PP 0x02
44#define CMD_M25PXX_SE 0xd8
45#define CMD_M25PXX_BE 0xc7
46#define CMD_M25PXX_DP 0xb9
47#define CMD_M25PXX_RES 0xab
48
49struct stmicro_spi_flash_params {
50 u8 idcode1;
51 u16 page_size;
52 u16 pages_per_sector;
53 u16 nr_sectors;
54 const char *name;
55};
56
57static const struct stmicro_spi_flash_params stmicro_spi_flash_table[] = {
58 {
59 .idcode1 = 0x11,
60 .page_size = 256,
61 .pages_per_sector = 128,
62 .nr_sectors = 4,
63 .name = "M25P10",
64 },
65 {
66 .idcode1 = 0x15,
67 .page_size = 256,
68 .pages_per_sector = 256,
69 .nr_sectors = 32,
70 .name = "M25P16",
71 },
72 {
73 .idcode1 = 0x12,
74 .page_size = 256,
75 .pages_per_sector = 256,
76 .nr_sectors = 4,
77 .name = "M25P20",
78 },
79 {
80 .idcode1 = 0x16,
81 .page_size = 256,
82 .pages_per_sector = 256,
83 .nr_sectors = 64,
84 .name = "M25P32",
85 },
86 {
87 .idcode1 = 0x13,
88 .page_size = 256,
89 .pages_per_sector = 256,
90 .nr_sectors = 8,
91 .name = "M25P40",
92 },
93 {
94 .idcode1 = 0x17,
95 .page_size = 256,
96 .pages_per_sector = 256,
97 .nr_sectors = 128,
98 .name = "M25P64",
99 },
100 {
101 .idcode1 = 0x14,
102 .page_size = 256,
103 .pages_per_sector = 256,
104 .nr_sectors = 16,
105 .name = "M25P80",
106 },
107 {
108 .idcode1 = 0x18,
109 .page_size = 256,
110 .pages_per_sector = 1024,
111 .nr_sectors = 64,
112 .name = "M25P128",
113 },
114};
115
116static int stmicro_erase(struct spi_flash *flash, u32 offset, size_t len)
117{
118 return spi_flash_cmd_erase(flash, CMD_M25PXX_SE, offset, len);
119}
120
121struct spi_flash *spi_flash_probe_stmicro(struct spi_slave *spi, u8 * idcode)
122{
123 const struct stmicro_spi_flash_params *params;
124 struct spi_flash *flash;
125 unsigned int i;
126
127 if (idcode[0] == 0xff) {
128 i = spi_flash_cmd(spi, CMD_M25PXX_RES,
129 idcode, 4);
130 if (i)
131 return NULL;
132 if ((idcode[3] & 0xf0) == 0x10) {
133 idcode[0] = 0x20;
134 idcode[1] = 0x20;
135 idcode[2] = idcode[3] + 1;
136 } else
137 return NULL;
138 }
139
140 for (i = 0; i < ARRAY_SIZE(stmicro_spi_flash_table); i++) {
141 params = &stmicro_spi_flash_table[i];
142 if (params->idcode1 == idcode[2]) {
143 break;
144 }
145 }
146
147 if (i == ARRAY_SIZE(stmicro_spi_flash_table)) {
148 debug("SF: Unsupported STMicro ID %02x\n", idcode[1]);
149 return NULL;
150 }
151
152 flash = malloc(sizeof(*flash));
153 if (!flash) {
154 debug("SF: Failed to allocate memory\n");
155 return NULL;
156 }
157
158 flash->spi = spi;
159 flash->name = params->name;
160
161 flash->write = spi_flash_cmd_write_multi;
162 flash->erase = stmicro_erase;
163 flash->read = spi_flash_cmd_read_fast;
164 flash->page_size = params->page_size;
165 flash->sector_size = params->page_size * params->pages_per_sector;
166 flash->size = flash->sector_size * params->nr_sectors;
167
168 return flash;
169}
170