2 * Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw>
4 * SPDX-License-Identifier: GPL-2.0+
10 #include <fdt_support.h>
15 DECLARE_GLOBAL_DATA_PTR;
17 /* The STATUS register */
18 #define QUADSPI_SR_BP0 BIT(2)
19 #define QUADSPI_SR_BP1 BIT(3)
20 #define QUADSPI_SR_BP2 BIT(4)
21 #define QUADSPI_SR_BP2_0 GENMASK(4, 2)
22 #define QUADSPI_SR_BP3 BIT(6)
23 #define QUADSPI_SR_TB BIT(5)
26 * The QUADSPI_MEM_OP register is used to do memory protect and erase operations
28 #define QUADSPI_MEM_OP_BULK_ERASE 0x00000001
29 #define QUADSPI_MEM_OP_SECTOR_ERASE 0x00000002
30 #define QUADSPI_MEM_OP_SECTOR_PROTECT 0x00000003
33 * The QUADSPI_ISR register is used to determine whether an invalid write or
34 * erase operation trigerred an interrupt
36 #define QUADSPI_ISR_ILLEGAL_ERASE BIT(0)
37 #define QUADSPI_ISR_ILLEGAL_WRITE BIT(1)
39 struct altera_qspi_regs {
49 struct altera_qspi_platdata {
50 struct altera_qspi_regs *regs;
55 flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS]; /* FLASH chips info */
57 static void altera_qspi_get_locked_range(struct mtd_info *mtd, loff_t *ofs,
60 void flash_print_info(flash_info_t *info)
62 struct mtd_info *mtd = info->mtd;
66 printf("Altera QSPI flash Size: %ld MB in %d Sectors\n",
67 info->size >> 20, info->sector_count);
68 altera_qspi_get_locked_range(mtd, &ofs, &len);
69 printf(" %08lX +%lX", info->start[0], info->size);
71 printf(", protected %08llX +%llX",
72 info->start[0] + ofs, len);
77 int flash_erase(flash_info_t *info, int s_first, int s_last)
79 struct mtd_info *mtd = info->mtd;
80 struct erase_info instr;
83 memset(&instr, 0, sizeof(instr));
85 instr.addr = mtd->erasesize * s_first;
86 instr.len = mtd->erasesize * (s_last + 1 - s_first);
87 ret = mtd_erase(mtd, &instr);
94 int write_buff(flash_info_t *info, uchar *src, ulong addr, ulong cnt)
96 struct mtd_info *mtd = info->mtd;
97 struct udevice *dev = mtd->dev;
98 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
99 ulong base = (ulong)pdata->base;
100 loff_t to = addr - base;
104 ret = mtd_write(mtd, to, cnt, &retlen, src);
106 return ERR_PROTECTED;
111 unsigned long flash_init(void)
115 /* probe every MTD device */
116 for (uclass_first_device(UCLASS_MTD, &dev);
118 uclass_next_device(&dev)) {
121 return flash_info[0].size;
124 static int altera_qspi_erase(struct mtd_info *mtd, struct erase_info *instr)
126 struct udevice *dev = mtd->dev;
127 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
128 struct altera_qspi_regs *regs = pdata->regs;
129 size_t addr = instr->addr;
130 size_t len = instr->len;
131 size_t end = addr + len;
136 instr->state = MTD_ERASING;
137 addr &= ~(mtd->erasesize - 1); /* get lower aligned address */
139 flash = pdata->base + addr;
140 last = pdata->base + addr + mtd->erasesize;
141 /* skip erase if sector is blank */
142 while (flash < last) {
143 if (readl(flash) != 0xffffffff)
148 sect = addr / mtd->erasesize;
150 sect |= QUADSPI_MEM_OP_SECTOR_ERASE;
151 debug("erase %08x\n", sect);
152 writel(sect, ®s->mem_op);
153 stat = readl(®s->isr);
154 if (stat & QUADSPI_ISR_ILLEGAL_ERASE) {
155 /* erase failed, sector might be protected */
156 debug("erase %08x fail %x\n", sect, stat);
157 writel(stat, ®s->isr); /* clear isr */
158 instr->fail_addr = addr;
159 instr->state = MTD_ERASE_FAILED;
160 mtd_erase_callback(instr);
164 addr += mtd->erasesize;
166 instr->state = MTD_ERASE_DONE;
167 mtd_erase_callback(instr);
172 static int altera_qspi_read(struct mtd_info *mtd, loff_t from, size_t len,
173 size_t *retlen, u_char *buf)
175 struct udevice *dev = mtd->dev;
176 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
178 memcpy_fromio(buf, pdata->base + from, len);
184 static int altera_qspi_write(struct mtd_info *mtd, loff_t to, size_t len,
185 size_t *retlen, const u_char *buf)
187 struct udevice *dev = mtd->dev;
188 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
189 struct altera_qspi_regs *regs = pdata->regs;
192 memcpy_toio(pdata->base + to, buf, len);
193 /* check whether write triggered a illegal write interrupt */
194 stat = readl(®s->isr);
195 if (stat & QUADSPI_ISR_ILLEGAL_WRITE) {
196 /* write failed, sector might be protected */
197 debug("write fail %x\n", stat);
198 writel(stat, ®s->isr); /* clear isr */
206 static void altera_qspi_sync(struct mtd_info *mtd)
210 static void altera_qspi_get_locked_range(struct mtd_info *mtd, loff_t *ofs,
213 struct udevice *dev = mtd->dev;
214 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
215 struct altera_qspi_regs *regs = pdata->regs;
216 int shift0 = ffs(QUADSPI_SR_BP2_0) - 1;
217 int shift3 = ffs(QUADSPI_SR_BP3) - 1 - 3;
218 u32 stat = readl(®s->rd_status);
219 unsigned pow = ((stat & QUADSPI_SR_BP2_0) >> shift0) |
220 ((stat & QUADSPI_SR_BP3) >> shift3);
225 *len = mtd->erasesize << (pow - 1);
226 if (*len > mtd->size)
228 if (!(stat & QUADSPI_SR_TB))
229 *ofs = mtd->size - *len;
233 static int altera_qspi_lock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
235 struct udevice *dev = mtd->dev;
236 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
237 struct altera_qspi_regs *regs = pdata->regs;
238 u32 sector_start, sector_end;
244 num_sectors = mtd->size / mtd->erasesize;
245 sector_start = ofs / mtd->erasesize;
246 sector_end = (ofs + len) / mtd->erasesize;
248 if (sector_start >= num_sectors / 2) {
249 sr_bp = fls(num_sectors - 1 - sector_start) + 1;
251 } else if (sector_end < num_sectors / 2) {
252 sr_bp = fls(sector_end) + 1;
259 mem_op = (sr_tb << 12) | (sr_bp << 8);
260 mem_op |= QUADSPI_MEM_OP_SECTOR_PROTECT;
261 debug("lock %08x\n", mem_op);
262 writel(mem_op, ®s->mem_op);
267 static int altera_qspi_unlock(struct mtd_info *mtd, loff_t ofs, uint64_t len)
269 struct udevice *dev = mtd->dev;
270 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
271 struct altera_qspi_regs *regs = pdata->regs;
274 mem_op = QUADSPI_MEM_OP_SECTOR_PROTECT;
275 debug("unlock %08x\n", mem_op);
276 writel(mem_op, ®s->mem_op);
281 static int altera_qspi_probe(struct udevice *dev)
283 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
284 struct altera_qspi_regs *regs = pdata->regs;
285 unsigned long base = (unsigned long)pdata->base;
286 struct mtd_info *mtd;
287 flash_info_t *flash = &flash_info[0];
291 rdid = readl(®s->rd_rdid);
292 debug("rdid %x\n", rdid);
294 mtd = dev_get_uclass_priv(dev);
297 mtd->type = MTD_NORFLASH;
298 mtd->flags = MTD_CAP_NORFLASH;
299 mtd->size = 1 << ((rdid & 0xff) - 6);
301 mtd->writebufsize = mtd->writesize;
302 mtd->_erase = altera_qspi_erase;
303 mtd->_read = altera_qspi_read;
304 mtd->_write = altera_qspi_write;
305 mtd->_sync = altera_qspi_sync;
306 mtd->_lock = altera_qspi_lock;
307 mtd->_unlock = altera_qspi_unlock;
308 mtd->numeraseregions = 0;
309 mtd->erasesize = 0x10000;
310 if (add_mtd_device(mtd))
314 flash->size = mtd->size;
315 flash->sector_count = mtd->size / mtd->erasesize;
316 flash->flash_id = rdid;
317 flash->start[0] = base;
318 for (i = 1; i < flash->sector_count; i++)
319 flash->start[i] = flash->start[i - 1] + mtd->erasesize;
320 gd->bd->bi_flashstart = base;
325 static int altera_qspi_ofdata_to_platdata(struct udevice *dev)
327 struct altera_qspi_platdata *pdata = dev_get_platdata(dev);
328 void *blob = (void *)gd->fdt_blob;
329 int node = dev->of_offset;
330 const char *list, *end;
333 unsigned long addr, size;
334 int parent, addrc, sizec;
338 * decode regs. there are multiple reg tuples, and they need to
339 * match with reg-names.
341 parent = fdt_parent_offset(blob, node);
342 of_bus_default_count_cells(blob, parent, &addrc, &sizec);
343 list = fdt_getprop(blob, node, "reg-names", &len);
347 cell = fdt_getprop(blob, node, "reg", &len);
352 addr = fdt_translate_address((void *)blob,
354 size = fdt_addr_to_cpu(cell[idx + addrc]);
355 base = map_physmem(addr, size, MAP_NOCACHE);
357 if (strcmp(list, "avl_csr") == 0) {
359 } else if (strcmp(list, "avl_mem") == 0) {
363 idx += addrc + sizec;
370 static const struct udevice_id altera_qspi_ids[] = {
371 { .compatible = "altr,quadspi-1.0" },
375 U_BOOT_DRIVER(altera_qspi) = {
376 .name = "altera_qspi",
378 .of_match = altera_qspi_ids,
379 .ofdata_to_platdata = altera_qspi_ofdata_to_platdata,
380 .platdata_auto_alloc_size = sizeof(struct altera_qspi_platdata),
381 .probe = altera_qspi_probe,