1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2011 Marek Vasut <marek.vasut@gmail.com>
6 * Copyright (C) 2005-2009 Samsung Electronics
7 * Kyungmin Park <kyungmin.park@samsung.com>
12 #include <linux/mtd/onenand_regs.h>
13 #include <onenand_uboot.h>
17 * - 2048b page, 128k erase block.
18 * - 4096b page, 256k erase block.
20 enum onenand_spl_pagesize {
25 static unsigned int density_mask;
27 #define ONENAND_PAGES_PER_BLOCK 64
28 #define onenand_sector_address(page) (page << 2)
29 #define onenand_buffer_address() ((1 << 3) << 8)
31 static inline int onenand_block_address(int block)
33 /* Device Flash Core select, NAND Flash Block Address */
34 if (block & density_mask)
35 return ONENAND_DDP_CHIP1 | (block ^ density_mask);
40 static inline int onenand_bufferram_address(int block)
42 /* Device BufferRAM Select */
43 if (block & density_mask)
44 return ONENAND_DDP_CHIP1;
46 return ONENAND_DDP_CHIP0;
49 static inline uint16_t onenand_readw(uint32_t addr)
51 return readw(CONFIG_SYS_ONENAND_BASE + addr);
54 static inline void onenand_writew(uint16_t value, uint32_t addr)
56 writew(value, CONFIG_SYS_ONENAND_BASE + addr);
59 static enum onenand_spl_pagesize onenand_spl_get_geometry(void)
61 unsigned int dev_id, density, size;
63 if (!onenand_readw(ONENAND_REG_TECHNOLOGY)) {
64 dev_id = onenand_readw(ONENAND_REG_DEVICE_ID);
65 density = dev_id >> ONENAND_DEVICE_DENSITY_SHIFT;
66 density &= ONENAND_DEVICE_DENSITY_MASK;
68 if (density < ONENAND_DEVICE_DENSITY_4Gb)
71 if (dev_id & ONENAND_DEVICE_IS_DDP) {
72 size = onenand_readw(ONENAND_REG_DATA_BUFFER_SIZE);
73 density_mask = 1 << (18 + density - ffs(size));
81 static int onenand_spl_read_page(uint32_t block, uint32_t page, uint32_t *buf,
82 enum onenand_spl_pagesize pagesize)
84 const uint32_t addr = CONFIG_SYS_ONENAND_BASE + ONENAND_DATARAM;
87 onenand_writew(onenand_block_address(block),
88 ONENAND_REG_START_ADDRESS1);
90 onenand_writew(onenand_bufferram_address(block),
91 ONENAND_REG_START_ADDRESS2);
93 onenand_writew(onenand_sector_address(page),
94 ONENAND_REG_START_ADDRESS8);
96 onenand_writew(onenand_buffer_address(),
97 ONENAND_REG_START_BUFFER);
99 onenand_writew(ONENAND_INT_CLEAR, ONENAND_REG_INTERRUPT);
101 onenand_writew(ONENAND_CMD_READ, ONENAND_REG_COMMAND);
103 while (!(onenand_readw(ONENAND_REG_INTERRUPT) & ONENAND_INT_READ))
106 /* Check for invalid block mark */
107 if (page < 2 && (onenand_readw(ONENAND_SPARERAM) != 0xffff))
110 for (offset = 0; offset < pagesize; offset += 4)
111 buf[offset / 4] = readl(addr + offset);
116 #ifdef CONFIG_SPL_UBI
117 /* Temporary storage for non page aligned and non page sized reads. */
118 static u8 scratch_buf[PAGE_4K];
121 * onenand_spl_read_block - Read data from physical eraseblock into a buffer
122 * @block: Number of the physical eraseblock
123 * @offset: Data offset from the start of @peb
124 * @len: Data size to read
125 * @dst: Address of the destination buffer
128 * @offset + @len are not allowed to be larger than a physical
129 * erase block. No sanity check done for simplicity reasons.
131 int onenand_spl_read_block(int block, int offset, int len, void *dst)
137 psize = onenand_spl_get_geometry();
139 /* Calculate the page number */
140 page = offset / psize;
141 /* Offset to the start of a flash page */
142 offset = offset % psize;
146 * Non page aligned reads go to the scratch buffer.
147 * Page aligned reads go directly to the destination.
149 if (offset || len < psize) {
150 onenand_spl_read_page(block, page,
151 (uint32_t *)scratch_buf, psize);
152 read = min(len, psize - offset);
153 memcpy(dst, scratch_buf + offset, read);
156 onenand_spl_read_page(block, page, dst, psize);
167 void onenand_spl_load_image(uint32_t offs, uint32_t size, void *dst)
169 uint32_t *addr = (uint32_t *)dst;
172 uint32_t page, rpage;
173 enum onenand_spl_pagesize pagesize;
176 pagesize = onenand_spl_get_geometry();
179 * The page can be either 2k or 4k, avoid using DIV_ROUND_UP to avoid
180 * pulling further unwanted functions into the SPL.
182 if (pagesize == 2048) {
184 to_page = page + DIV_ROUND_UP(size, 2048);
187 to_page = page + DIV_ROUND_UP(size, 4096);
190 for (; page <= to_page; page++) {
191 block = page / ONENAND_PAGES_PER_BLOCK;
192 rpage = page & (ONENAND_PAGES_PER_BLOCK - 1);
193 ret = onenand_spl_read_page(block, rpage, addr, pagesize);
195 page += ONENAND_PAGES_PER_BLOCK - 1;
197 addr += pagesize / 4;