Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2014-2015, Antmicro Ltd <www.antmicro.com> |
| 3 | * Copyright (c) 2015, AW-SOM Technologies <www.aw-som.com> |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | */ |
| 7 | |
Hans de Goede | 466a318 | 2015-08-15 11:59:25 +0200 | [diff] [blame] | 8 | #include <asm/arch/clock.h> |
| 9 | #include <asm/io.h> |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 10 | #include <common.h> |
| 11 | #include <config.h> |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 12 | #include <nand.h> |
| 13 | |
| 14 | /* registers */ |
| 15 | #define NFC_CTL 0x00000000 |
| 16 | #define NFC_ST 0x00000004 |
| 17 | #define NFC_INT 0x00000008 |
| 18 | #define NFC_TIMING_CTL 0x0000000C |
| 19 | #define NFC_TIMING_CFG 0x00000010 |
| 20 | #define NFC_ADDR_LOW 0x00000014 |
| 21 | #define NFC_ADDR_HIGH 0x00000018 |
| 22 | #define NFC_SECTOR_NUM 0x0000001C |
| 23 | #define NFC_CNT 0x00000020 |
| 24 | #define NFC_CMD 0x00000024 |
| 25 | #define NFC_RCMD_SET 0x00000028 |
| 26 | #define NFC_WCMD_SET 0x0000002C |
| 27 | #define NFC_IO_DATA 0x00000030 |
| 28 | #define NFC_ECC_CTL 0x00000034 |
| 29 | #define NFC_ECC_ST 0x00000038 |
| 30 | #define NFC_DEBUG 0x0000003C |
| 31 | #define NFC_ECC_CNT0 0x00000040 |
| 32 | #define NFC_ECC_CNT1 0x00000044 |
| 33 | #define NFC_ECC_CNT2 0x00000048 |
| 34 | #define NFC_ECC_CNT3 0x0000004C |
| 35 | #define NFC_USER_DATA_BASE 0x00000050 |
| 36 | #define NFC_EFNAND_STATUS 0x00000090 |
| 37 | #define NFC_SPARE_AREA 0x000000A0 |
| 38 | #define NFC_PATTERN_ID 0x000000A4 |
| 39 | #define NFC_RAM0_BASE 0x00000400 |
| 40 | #define NFC_RAM1_BASE 0x00000800 |
| 41 | |
| 42 | #define NFC_CTL_EN (1 << 0) |
| 43 | #define NFC_CTL_RESET (1 << 1) |
| 44 | #define NFC_CTL_RAM_METHOD (1 << 14) |
Hans de Goede | f851120 | 2015-08-15 20:05:13 +0200 | [diff] [blame] | 45 | #define NFC_CTL_PAGE_SIZE_MASK (0xf << 8) |
| 46 | #define NFC_CTL_PAGE_SIZE(a) ((fls(a) - 11) << 8) |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 47 | |
| 48 | |
| 49 | #define NFC_ECC_EN (1 << 0) |
| 50 | #define NFC_ECC_PIPELINE (1 << 3) |
| 51 | #define NFC_ECC_EXCEPTION (1 << 4) |
| 52 | #define NFC_ECC_BLOCK_SIZE (1 << 5) |
| 53 | #define NFC_ECC_RANDOM_EN (1 << 9) |
| 54 | #define NFC_ECC_RANDOM_DIRECTION (1 << 10) |
| 55 | |
| 56 | |
| 57 | #define NFC_ADDR_NUM_OFFSET 16 |
| 58 | #define NFC_SEND_ADR (1 << 19) |
| 59 | #define NFC_ACCESS_DIR (1 << 20) |
| 60 | #define NFC_DATA_TRANS (1 << 21) |
| 61 | #define NFC_SEND_CMD1 (1 << 22) |
| 62 | #define NFC_WAIT_FLAG (1 << 23) |
| 63 | #define NFC_SEND_CMD2 (1 << 24) |
| 64 | #define NFC_SEQ (1 << 25) |
| 65 | #define NFC_DATA_SWAP_METHOD (1 << 26) |
| 66 | #define NFC_ROW_AUTO_INC (1 << 27) |
| 67 | #define NFC_SEND_CMD3 (1 << 28) |
| 68 | #define NFC_SEND_CMD4 (1 << 29) |
| 69 | |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 70 | #define NFC_ST_CMD_INT_FLAG (1 << 1) |
| 71 | #define NFC_ST_DMA_INT_FLAG (1 << 2) |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 72 | |
| 73 | #define NFC_READ_CMD_OFFSET 0 |
| 74 | #define NFC_RANDOM_READ_CMD0_OFFSET 8 |
| 75 | #define NFC_RANDOM_READ_CMD1_OFFSET 16 |
| 76 | |
| 77 | #define NFC_CMD_RNDOUTSTART 0xE0 |
| 78 | #define NFC_CMD_RNDOUT 0x05 |
| 79 | #define NFC_CMD_READSTART 0x30 |
| 80 | |
| 81 | |
| 82 | #define NFC_PAGE_CMD (2 << 30) |
| 83 | |
| 84 | #define SUNXI_DMA_CFG_REG0 0x300 |
| 85 | #define SUNXI_DMA_SRC_START_ADDR_REG0 0x304 |
| 86 | #define SUNXI_DMA_DEST_START_ADDRR_REG0 0x308 |
| 87 | #define SUNXI_DMA_DDMA_BC_REG0 0x30C |
| 88 | #define SUNXI_DMA_DDMA_PARA_REG0 0x318 |
| 89 | |
| 90 | #define SUNXI_DMA_DDMA_CFG_REG_LOADING (1 << 31) |
| 91 | #define SUNXI_DMA_DDMA_CFG_REG_DMA_DEST_DATA_WIDTH_32 (2 << 25) |
Hans de Goede | 534e607 | 2015-08-15 09:33:41 +0200 | [diff] [blame] | 92 | #define SUNXI_DMA_DDMA_CFG_REG_DDMA_DST_DRQ_TYPE_DRAM (1 << 16) |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 93 | #define SUNXI_DMA_DDMA_CFG_REG_DMA_SRC_DATA_WIDTH_32 (2 << 9) |
| 94 | #define SUNXI_DMA_DDMA_CFG_REG_DMA_SRC_ADDR_MODE_IO (1 << 5) |
| 95 | #define SUNXI_DMA_DDMA_CFG_REG_DDMA_SRC_DRQ_TYPE_NFC (3 << 0) |
| 96 | |
| 97 | #define SUNXI_DMA_DDMA_PARA_REG_SRC_WAIT_CYC (0x0F << 0) |
| 98 | #define SUNXI_DMA_DDMA_PARA_REG_SRC_BLK_SIZE (0x7F << 8) |
| 99 | |
| 100 | /* minimal "boot0" style NAND support for Allwinner A20 */ |
| 101 | |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 102 | /* random seed used by linux */ |
| 103 | const uint16_t random_seed[128] = { |
| 104 | 0x2b75, 0x0bd0, 0x5ca3, 0x62d1, 0x1c93, 0x07e9, 0x2162, 0x3a72, |
| 105 | 0x0d67, 0x67f9, 0x1be7, 0x077d, 0x032f, 0x0dac, 0x2716, 0x2436, |
| 106 | 0x7922, 0x1510, 0x3860, 0x5287, 0x480f, 0x4252, 0x1789, 0x5a2d, |
| 107 | 0x2a49, 0x5e10, 0x437f, 0x4b4e, 0x2f45, 0x216e, 0x5cb7, 0x7130, |
| 108 | 0x2a3f, 0x60e4, 0x4dc9, 0x0ef0, 0x0f52, 0x1bb9, 0x6211, 0x7a56, |
| 109 | 0x226d, 0x4ea7, 0x6f36, 0x3692, 0x38bf, 0x0c62, 0x05eb, 0x4c55, |
| 110 | 0x60f4, 0x728c, 0x3b6f, 0x2037, 0x7f69, 0x0936, 0x651a, 0x4ceb, |
| 111 | 0x6218, 0x79f3, 0x383f, 0x18d9, 0x4f05, 0x5c82, 0x2912, 0x6f17, |
| 112 | 0x6856, 0x5938, 0x1007, 0x61ab, 0x3e7f, 0x57c2, 0x542f, 0x4f62, |
| 113 | 0x7454, 0x2eac, 0x7739, 0x42d4, 0x2f90, 0x435a, 0x2e52, 0x2064, |
| 114 | 0x637c, 0x66ad, 0x2c90, 0x0bad, 0x759c, 0x0029, 0x0986, 0x7126, |
| 115 | 0x1ca7, 0x1605, 0x386a, 0x27f5, 0x1380, 0x6d75, 0x24c3, 0x0f8e, |
| 116 | 0x2b7a, 0x1418, 0x1fd1, 0x7dc1, 0x2d8e, 0x43af, 0x2267, 0x7da3, |
| 117 | 0x4e3d, 0x1338, 0x50db, 0x454d, 0x764d, 0x40a3, 0x42e6, 0x262b, |
| 118 | 0x2d2e, 0x1aea, 0x2e17, 0x173d, 0x3a6e, 0x71bf, 0x25f9, 0x0a5d, |
| 119 | 0x7c57, 0x0fbe, 0x46ce, 0x4939, 0x6b17, 0x37bb, 0x3e91, 0x76db, |
| 120 | }; |
| 121 | |
| 122 | /* random seed used for syndrome calls */ |
| 123 | const uint16_t random_seed_syndrome = 0x4a80; |
| 124 | |
| 125 | #define MAX_RETRIES 10 |
| 126 | |
| 127 | static int check_value_inner(int offset, int expected_bits, |
| 128 | int max_number_of_retries, int negation) |
| 129 | { |
| 130 | int retries = 0; |
| 131 | do { |
| 132 | int val = readl(offset) & expected_bits; |
| 133 | if (negation ? !val : val) |
| 134 | return 1; |
| 135 | mdelay(1); |
| 136 | retries++; |
| 137 | } while (retries < max_number_of_retries); |
| 138 | |
| 139 | return 0; |
| 140 | } |
| 141 | |
| 142 | static inline int check_value(int offset, int expected_bits, |
| 143 | int max_number_of_retries) |
| 144 | { |
| 145 | return check_value_inner(offset, expected_bits, |
| 146 | max_number_of_retries, 0); |
| 147 | } |
| 148 | |
| 149 | static inline int check_value_negated(int offset, int unexpected_bits, |
| 150 | int max_number_of_retries) |
| 151 | { |
| 152 | return check_value_inner(offset, unexpected_bits, |
| 153 | max_number_of_retries, 1); |
| 154 | } |
| 155 | |
| 156 | void nand_init(void) |
| 157 | { |
| 158 | uint32_t val; |
| 159 | |
Hans de Goede | 5ed52f6 | 2015-08-15 11:55:26 +0200 | [diff] [blame] | 160 | board_nand_init(); |
| 161 | |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 162 | val = readl(SUNXI_NFC_BASE + NFC_CTL); |
| 163 | /* enable and reset CTL */ |
| 164 | writel(val | NFC_CTL_EN | NFC_CTL_RESET, |
| 165 | SUNXI_NFC_BASE + NFC_CTL); |
| 166 | |
| 167 | if (!check_value_negated(SUNXI_NFC_BASE + NFC_CTL, |
| 168 | NFC_CTL_RESET, MAX_RETRIES)) { |
| 169 | printf("Couldn't initialize nand\n"); |
| 170 | } |
Hans de Goede | 7c7fbfb | 2015-08-15 11:38:33 +0200 | [diff] [blame] | 171 | |
| 172 | /* reset NAND */ |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 173 | writel(NFC_ST_CMD_INT_FLAG, SUNXI_NFC_BASE + NFC_ST); |
Hans de Goede | 7c7fbfb | 2015-08-15 11:38:33 +0200 | [diff] [blame] | 174 | writel(NFC_SEND_CMD1 | NFC_WAIT_FLAG | NAND_CMD_RESET, |
| 175 | SUNXI_NFC_BASE + NFC_CMD); |
| 176 | |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 177 | if (!check_value(SUNXI_NFC_BASE + NFC_ST, NFC_ST_CMD_INT_FLAG, |
Hans de Goede | 7c7fbfb | 2015-08-15 11:38:33 +0200 | [diff] [blame] | 178 | MAX_RETRIES)) { |
| 179 | printf("Error timeout waiting for nand reset\n"); |
| 180 | return; |
| 181 | } |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 182 | writel(NFC_ST_CMD_INT_FLAG, SUNXI_NFC_BASE + NFC_ST); |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 183 | } |
| 184 | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 185 | static int nand_read_page(int page_size, int ecc_strength, int ecc_page_size, |
| 186 | int addr_cycles, uint32_t real_addr, dma_addr_t dst, int syndrome) |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 187 | { |
| 188 | uint32_t val; |
Hans de Goede | c270b48 | 2015-08-15 12:41:09 +0200 | [diff] [blame] | 189 | int i, ecc_off = 0; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 190 | uint16_t ecc_mode = 0; |
| 191 | uint16_t rand_seed; |
| 192 | uint32_t page; |
| 193 | uint16_t column; |
Hans de Goede | c270b48 | 2015-08-15 12:41:09 +0200 | [diff] [blame] | 194 | static const u8 strengths[] = { 16, 24, 28, 32, 40, 48, 56, 60, 64 }; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 195 | |
Hans de Goede | c270b48 | 2015-08-15 12:41:09 +0200 | [diff] [blame] | 196 | for (i = 0; i < ARRAY_SIZE(strengths); i++) { |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 197 | if (ecc_strength == strengths[i]) { |
Hans de Goede | c270b48 | 2015-08-15 12:41:09 +0200 | [diff] [blame] | 198 | ecc_mode = i; |
| 199 | break; |
| 200 | } |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 201 | } |
| 202 | |
Hans de Goede | c270b48 | 2015-08-15 12:41:09 +0200 | [diff] [blame] | 203 | /* HW ECC always request ECC bytes for 1024 bytes blocks */ |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 204 | ecc_off = DIV_ROUND_UP(ecc_strength * fls(8 * 1024), 8); |
Hans de Goede | c270b48 | 2015-08-15 12:41:09 +0200 | [diff] [blame] | 205 | /* HW ECC always work with even numbers of ECC bytes */ |
| 206 | ecc_off += (ecc_off & 1); |
| 207 | ecc_off += 4; /* prepad */ |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 208 | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 209 | page = real_addr / page_size; |
| 210 | column = real_addr % page_size; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 211 | |
| 212 | if (syndrome) |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 213 | column += (column / ecc_page_size) * ecc_off; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 214 | |
| 215 | /* clear ecc status */ |
| 216 | writel(0, SUNXI_NFC_BASE + NFC_ECC_ST); |
| 217 | |
| 218 | /* Choose correct seed */ |
| 219 | if (syndrome) |
| 220 | rand_seed = random_seed_syndrome; |
| 221 | else |
| 222 | rand_seed = random_seed[page % 128]; |
| 223 | |
| 224 | writel((rand_seed << 16) | NFC_ECC_RANDOM_EN | NFC_ECC_EN |
| 225 | | NFC_ECC_PIPELINE | (ecc_mode << 12), |
| 226 | SUNXI_NFC_BASE + NFC_ECC_CTL); |
| 227 | |
| 228 | val = readl(SUNXI_NFC_BASE + NFC_CTL); |
| 229 | writel(val | NFC_CTL_RAM_METHOD, SUNXI_NFC_BASE + NFC_CTL); |
| 230 | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 231 | if (!syndrome) |
| 232 | writel(page_size + (column / ecc_page_size) * ecc_off, |
| 233 | SUNXI_NFC_BASE + NFC_SPARE_AREA); |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 234 | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 235 | flush_dcache_range(dst, ALIGN(dst + ecc_page_size, ARCH_DMA_MINALIGN)); |
Hans de Goede | 4de74a4 | 2015-08-15 12:32:24 +0200 | [diff] [blame] | 236 | |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 237 | /* SUNXI_DMA */ |
| 238 | writel(0x0, SUNXI_DMA_BASE + SUNXI_DMA_CFG_REG0); /* clr dma cmd */ |
| 239 | /* read from REG_IO_DATA */ |
| 240 | writel(SUNXI_NFC_BASE + NFC_IO_DATA, |
| 241 | SUNXI_DMA_BASE + SUNXI_DMA_SRC_START_ADDR_REG0); |
| 242 | /* read to RAM */ |
Hans de Goede | 534e607 | 2015-08-15 09:33:41 +0200 | [diff] [blame] | 243 | writel(dst, SUNXI_DMA_BASE + SUNXI_DMA_DEST_START_ADDRR_REG0); |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 244 | writel(SUNXI_DMA_DDMA_PARA_REG_SRC_WAIT_CYC |
| 245 | | SUNXI_DMA_DDMA_PARA_REG_SRC_BLK_SIZE, |
| 246 | SUNXI_DMA_BASE + SUNXI_DMA_DDMA_PARA_REG0); |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 247 | writel(ecc_page_size, |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 248 | SUNXI_DMA_BASE + SUNXI_DMA_DDMA_BC_REG0); /* 1kB */ |
| 249 | writel(SUNXI_DMA_DDMA_CFG_REG_LOADING |
| 250 | | SUNXI_DMA_DDMA_CFG_REG_DMA_DEST_DATA_WIDTH_32 |
Hans de Goede | 534e607 | 2015-08-15 09:33:41 +0200 | [diff] [blame] | 251 | | SUNXI_DMA_DDMA_CFG_REG_DDMA_DST_DRQ_TYPE_DRAM |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 252 | | SUNXI_DMA_DDMA_CFG_REG_DMA_SRC_DATA_WIDTH_32 |
| 253 | | SUNXI_DMA_DDMA_CFG_REG_DMA_SRC_ADDR_MODE_IO |
| 254 | | SUNXI_DMA_DDMA_CFG_REG_DDMA_SRC_DRQ_TYPE_NFC, |
| 255 | SUNXI_DMA_BASE + SUNXI_DMA_CFG_REG0); |
| 256 | |
| 257 | writel((NFC_CMD_RNDOUTSTART << NFC_RANDOM_READ_CMD1_OFFSET) |
| 258 | | (NFC_CMD_RNDOUT << NFC_RANDOM_READ_CMD0_OFFSET) |
| 259 | | (NFC_CMD_READSTART | NFC_READ_CMD_OFFSET), SUNXI_NFC_BASE |
| 260 | + NFC_RCMD_SET); |
| 261 | writel(1, SUNXI_NFC_BASE + NFC_SECTOR_NUM); |
| 262 | writel(((page & 0xFFFF) << 16) | column, |
| 263 | SUNXI_NFC_BASE + NFC_ADDR_LOW); |
| 264 | writel((page >> 16) & 0xFF, SUNXI_NFC_BASE + NFC_ADDR_HIGH); |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 265 | writel(NFC_ST_DMA_INT_FLAG, SUNXI_NFC_BASE + NFC_ST); |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 266 | writel(NFC_SEND_CMD1 | NFC_SEND_CMD2 | NFC_DATA_TRANS | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 267 | NFC_PAGE_CMD | NFC_WAIT_FLAG | |
| 268 | ((addr_cycles - 1) << NFC_ADDR_NUM_OFFSET) | |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 269 | NFC_SEND_ADR | NFC_DATA_SWAP_METHOD | (syndrome ? NFC_SEQ : 0), |
| 270 | SUNXI_NFC_BASE + NFC_CMD); |
| 271 | |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 272 | if (!check_value(SUNXI_NFC_BASE + NFC_ST, NFC_ST_DMA_INT_FLAG, |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 273 | MAX_RETRIES)) { |
| 274 | printf("Error while initializing dma interrupt\n"); |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 275 | return -1; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 276 | } |
Boris Brezillon | 353f3d0 | 2015-08-29 12:29:38 +0200 | [diff] [blame] | 277 | writel(NFC_ST_DMA_INT_FLAG, SUNXI_NFC_BASE + NFC_ST); |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 278 | |
| 279 | if (!check_value_negated(SUNXI_DMA_BASE + SUNXI_DMA_CFG_REG0, |
| 280 | SUNXI_DMA_DDMA_CFG_REG_LOADING, MAX_RETRIES)) { |
| 281 | printf("Error while waiting for dma transfer to finish\n"); |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 282 | return -1; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 283 | } |
| 284 | |
Hans de Goede | 4de74a4 | 2015-08-15 12:32:24 +0200 | [diff] [blame] | 285 | invalidate_dcache_range(dst, |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 286 | ALIGN(dst + ecc_page_size, ARCH_DMA_MINALIGN)); |
Hans de Goede | 4de74a4 | 2015-08-15 12:32:24 +0200 | [diff] [blame] | 287 | |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 288 | if (readl(SUNXI_NFC_BASE + NFC_ECC_ST)) |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 289 | return -1; |
| 290 | |
| 291 | return 0; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 292 | } |
| 293 | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 294 | static int nand_read_ecc(int page_size, int ecc_strength, int ecc_page_size, |
| 295 | int addr_cycles, uint32_t offs, uint32_t size, void *dest, int syndrome) |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 296 | { |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 297 | void *end = dest + size; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 298 | |
Hans de Goede | f851120 | 2015-08-15 20:05:13 +0200 | [diff] [blame] | 299 | clrsetbits_le32(SUNXI_NFC_BASE + NFC_CTL, NFC_CTL_PAGE_SIZE_MASK, |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 300 | NFC_CTL_PAGE_SIZE(page_size)); |
Hans de Goede | f851120 | 2015-08-15 20:05:13 +0200 | [diff] [blame] | 301 | |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 302 | for ( ;dest < end; dest += ecc_page_size, offs += ecc_page_size) { |
| 303 | if (nand_read_page(page_size, ecc_strength, ecc_page_size, |
| 304 | addr_cycles, offs, (dma_addr_t)dest, |
| 305 | syndrome)) |
| 306 | return -1; |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 307 | } |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 308 | |
| 309 | return 0; |
| 310 | } |
| 311 | |
| 312 | static int nand_read_buffer(uint32_t offs, unsigned int size, void *dest, |
| 313 | int syndrome) |
| 314 | { |
Hans de Goede | 01c69ed | 2015-08-15 21:23:08 +0200 | [diff] [blame] | 315 | const struct { |
| 316 | int page_size; |
| 317 | int ecc_strength; |
| 318 | int ecc_page_size; |
| 319 | int addr_cycles; |
| 320 | } nand_configs[] = { |
| 321 | { 8192, 40, 1024, 5 }, |
| 322 | { 16384, 56, 1024, 5 }, |
| 323 | { 8192, 24, 1024, 5 }, |
Stefan Roese | 8b9d291 | 2015-09-04 14:43:00 +0200 | [diff] [blame] | 324 | { 4096, 24, 1024, 5 }, |
Hans de Goede | 01c69ed | 2015-08-15 21:23:08 +0200 | [diff] [blame] | 325 | }; |
| 326 | static int nand_config = -1; |
| 327 | int i; |
| 328 | |
| 329 | if (nand_config == -1) { |
| 330 | for (i = 0; i < ARRAY_SIZE(nand_configs); i++) { |
| 331 | debug("nand: trying page %d ecc %d / %d addr %d: ", |
| 332 | nand_configs[i].page_size, |
| 333 | nand_configs[i].ecc_strength, |
| 334 | nand_configs[i].ecc_page_size, |
| 335 | nand_configs[i].addr_cycles); |
| 336 | if (nand_read_ecc(nand_configs[i].page_size, |
| 337 | nand_configs[i].ecc_strength, |
| 338 | nand_configs[i].ecc_page_size, |
| 339 | nand_configs[i].addr_cycles, |
| 340 | offs, size, dest, syndrome) == 0) { |
| 341 | debug("success\n"); |
| 342 | nand_config = i; |
| 343 | return 0; |
| 344 | } |
| 345 | debug("failed\n"); |
| 346 | } |
| 347 | return -1; |
| 348 | } |
| 349 | |
| 350 | return nand_read_ecc(nand_configs[nand_config].page_size, |
| 351 | nand_configs[nand_config].ecc_strength, |
| 352 | nand_configs[nand_config].ecc_page_size, |
| 353 | nand_configs[nand_config].addr_cycles, |
| 354 | offs, size, dest, syndrome); |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 355 | } |
| 356 | |
| 357 | int nand_spl_load_image(uint32_t offs, unsigned int size, void *dest) |
| 358 | { |
Hans de Goede | eb715f6 | 2015-08-31 16:00:56 +0200 | [diff] [blame] | 359 | #if CONFIG_SYS_NAND_U_BOOT_OFFS == CONFIG_SPL_PAD_TO |
| 360 | /* |
| 361 | * u-boot-dtb.bin appended to SPL, use syndrome (like the BROM does) |
| 362 | * and try different erase block sizes to find the backup. |
| 363 | */ |
Hans de Goede | 5a34ee2 | 2015-08-15 21:51:33 +0200 | [diff] [blame] | 364 | const uint32_t boot_offsets[] = { |
| 365 | 0 * 1024 * 1024 + CONFIG_SYS_NAND_U_BOOT_OFFS, |
| 366 | 1 * 1024 * 1024 + CONFIG_SYS_NAND_U_BOOT_OFFS, |
| 367 | 2 * 1024 * 1024 + CONFIG_SYS_NAND_U_BOOT_OFFS, |
| 368 | 4 * 1024 * 1024 + CONFIG_SYS_NAND_U_BOOT_OFFS, |
| 369 | }; |
Hans de Goede | eb715f6 | 2015-08-31 16:00:56 +0200 | [diff] [blame] | 370 | const int syndrome = 1; |
| 371 | #else |
| 372 | /* |
| 373 | * u-boot-dtb.bin on its own partition, do not use syndrome, u-boot |
| 374 | * partition sits after 2 eraseblocks (spl, spl-backup), look for |
| 375 | * backup u-boot 1 erase block further. |
| 376 | */ |
| 377 | const uint32_t eraseblock_size = CONFIG_SYS_NAND_U_BOOT_OFFS / 2; |
| 378 | const uint32_t boot_offsets[] = { |
| 379 | CONFIG_SYS_NAND_U_BOOT_OFFS, |
| 380 | CONFIG_SYS_NAND_U_BOOT_OFFS + eraseblock_size, |
| 381 | }; |
| 382 | const int syndrome = 0; |
| 383 | #endif |
| 384 | int i; |
Hans de Goede | 5a34ee2 | 2015-08-15 21:51:33 +0200 | [diff] [blame] | 385 | |
| 386 | if (offs == CONFIG_SYS_NAND_U_BOOT_OFFS) { |
| 387 | for (i = 0; i < ARRAY_SIZE(boot_offsets); i++) { |
| 388 | if (nand_read_buffer(boot_offsets[i], size, |
| 389 | dest, syndrome) == 0) |
| 390 | return 0; |
| 391 | } |
| 392 | return -1; |
| 393 | } |
Hans de Goede | a44f40e | 2015-08-15 20:51:53 +0200 | [diff] [blame] | 394 | |
| 395 | return nand_read_buffer(offs, size, dest, syndrome); |
Piotr Zierhoffer | 4ac391c | 2015-07-23 14:33:02 +0200 | [diff] [blame] | 396 | } |
| 397 | |
Hans de Goede | 466a318 | 2015-08-15 11:59:25 +0200 | [diff] [blame] | 398 | void nand_deselect(void) |
| 399 | { |
| 400 | struct sunxi_ccm_reg *const ccm = |
| 401 | (struct sunxi_ccm_reg *)SUNXI_CCM_BASE; |
| 402 | |
| 403 | clrbits_le32(&ccm->ahb_gate0, (CLK_GATE_OPEN << AHB_GATE_OFFSET_NAND0)); |
| 404 | #ifdef CONFIG_MACH_SUN9I |
| 405 | clrbits_le32(&ccm->ahb_gate1, (1 << AHB_GATE_OFFSET_DMA)); |
| 406 | #else |
| 407 | clrbits_le32(&ccm->ahb_gate0, (1 << AHB_GATE_OFFSET_DMA)); |
| 408 | #endif |
| 409 | clrbits_le32(&ccm->nand0_clk_cfg, CCM_NAND_CTRL_ENABLE | AHB_DIV_1); |
| 410 | } |