Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1 | /* |
| 2 | * NAND Flash Controller Device Driver |
| 3 | * Copyright © 2009-2010, Intel Corporation and its suppliers. |
| 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify it |
| 6 | * under the terms and conditions of the GNU General Public License, |
| 7 | * version 2, as published by the Free Software Foundation. |
| 8 | * |
| 9 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 12 | * more details. |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 13 | */ |
Masahiro Yamada | da4734b | 2017-09-22 12:46:40 +0900 | [diff] [blame] | 14 | |
Masahiro Yamada | e0d53b3 | 2017-09-22 12:46:43 +0900 | [diff] [blame] | 15 | #include <linux/bitfield.h> |
Masahiro Yamada | da4734b | 2017-09-22 12:46:40 +0900 | [diff] [blame] | 16 | #include <linux/completion.h> |
Jamie Iles | 8445794 | 2011-05-06 15:28:55 +0100 | [diff] [blame] | 17 | #include <linux/dma-mapping.h> |
Masahiro Yamada | da4734b | 2017-09-22 12:46:40 +0900 | [diff] [blame] | 18 | #include <linux/interrupt.h> |
| 19 | #include <linux/io.h> |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 20 | #include <linux/module.h> |
Masahiro Yamada | da4734b | 2017-09-22 12:46:40 +0900 | [diff] [blame] | 21 | #include <linux/mtd/mtd.h> |
| 22 | #include <linux/mtd/rawnand.h> |
Masahiro Yamada | 7d370b2 | 2017-06-13 22:45:48 +0900 | [diff] [blame] | 23 | #include <linux/slab.h> |
Masahiro Yamada | da4734b | 2017-09-22 12:46:40 +0900 | [diff] [blame] | 24 | #include <linux/spinlock.h> |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 25 | |
| 26 | #include "denali.h" |
| 27 | |
| 28 | MODULE_LICENSE("GPL"); |
| 29 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 30 | #define DENALI_NAND_NAME "denali-nand" |
| 31 | |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 32 | /* for Indexed Addressing */ |
| 33 | #define DENALI_INDEXED_CTRL 0x00 |
| 34 | #define DENALI_INDEXED_DATA 0x10 |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 35 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 36 | #define DENALI_MAP00 (0 << 26) /* direct access to buffer */ |
| 37 | #define DENALI_MAP01 (1 << 26) /* read/write pages in PIO */ |
| 38 | #define DENALI_MAP10 (2 << 26) /* high-level control plane */ |
| 39 | #define DENALI_MAP11 (3 << 26) /* direct controller access */ |
| 40 | |
| 41 | /* MAP11 access cycle type */ |
| 42 | #define DENALI_MAP11_CMD ((DENALI_MAP11) | 0) /* command cycle */ |
| 43 | #define DENALI_MAP11_ADDR ((DENALI_MAP11) | 1) /* address cycle */ |
| 44 | #define DENALI_MAP11_DATA ((DENALI_MAP11) | 2) /* data cycle */ |
| 45 | |
| 46 | /* MAP10 commands */ |
| 47 | #define DENALI_ERASE 0x01 |
| 48 | |
| 49 | #define DENALI_BANK(denali) ((denali)->active_bank << 24) |
| 50 | |
| 51 | #define DENALI_INVALID_BANK -1 |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 52 | #define DENALI_NR_BANKS 4 |
| 53 | |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 54 | /* |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 55 | * The bus interface clock, clk_x, is phase aligned with the core clock. The |
| 56 | * clk_x is an integral multiple N of the core clk. The value N is configured |
| 57 | * at IP delivery time, and its available value is 4, 5, or 6. We need to align |
| 58 | * to the largest value to make it work with any possible configuration. |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 59 | */ |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 60 | #define DENALI_CLK_X_MULT 6 |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 61 | |
Boris BREZILLON | 442f201b | 2015-12-11 15:06:00 +0100 | [diff] [blame] | 62 | static inline struct denali_nand_info *mtd_to_denali(struct mtd_info *mtd) |
| 63 | { |
| 64 | return container_of(mtd_to_nand(mtd), struct denali_nand_info, nand); |
| 65 | } |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 66 | |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 67 | /* |
| 68 | * Direct Addressing - the slave address forms the control information (command |
| 69 | * type, bank, block, and page address). The slave data is the actual data to |
| 70 | * be transferred. This mode requires 28 bits of address region allocated. |
| 71 | */ |
| 72 | static u32 denali_direct_read(struct denali_nand_info *denali, u32 addr) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 73 | { |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 74 | return ioread32(denali->host + addr); |
| 75 | } |
| 76 | |
| 77 | static void denali_direct_write(struct denali_nand_info *denali, u32 addr, |
| 78 | u32 data) |
| 79 | { |
| 80 | iowrite32(data, denali->host + addr); |
| 81 | } |
| 82 | |
| 83 | /* |
| 84 | * Indexed Addressing - address translation module intervenes in passing the |
| 85 | * control information. This mode reduces the required address range. The |
| 86 | * control information and transferred data are latched by the registers in |
| 87 | * the translation module. |
| 88 | */ |
| 89 | static u32 denali_indexed_read(struct denali_nand_info *denali, u32 addr) |
| 90 | { |
| 91 | iowrite32(addr, denali->host + DENALI_INDEXED_CTRL); |
| 92 | return ioread32(denali->host + DENALI_INDEXED_DATA); |
| 93 | } |
| 94 | |
| 95 | static void denali_indexed_write(struct denali_nand_info *denali, u32 addr, |
| 96 | u32 data) |
| 97 | { |
| 98 | iowrite32(addr, denali->host + DENALI_INDEXED_CTRL); |
| 99 | iowrite32(data, denali->host + DENALI_INDEXED_DATA); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 100 | } |
| 101 | |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 102 | /* |
Jamie Iles | c89eeda | 2011-05-06 15:28:57 +0100 | [diff] [blame] | 103 | * Use the configuration feature register to determine the maximum number of |
| 104 | * banks that the hardware supports. |
| 105 | */ |
Masahiro Yamada | 3ac6c71 | 2017-09-22 12:46:39 +0900 | [diff] [blame] | 106 | static void denali_detect_max_banks(struct denali_nand_info *denali) |
Jamie Iles | c89eeda | 2011-05-06 15:28:57 +0100 | [diff] [blame] | 107 | { |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 108 | uint32_t features = ioread32(denali->reg + FEATURES); |
Jamie Iles | c89eeda | 2011-05-06 15:28:57 +0100 | [diff] [blame] | 109 | |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 110 | denali->max_banks = 1 << FIELD_GET(FEATURES__N_BANKS, features); |
Masahiro Yamada | e7beeee | 2017-03-30 15:45:57 +0900 | [diff] [blame] | 111 | |
| 112 | /* the encoding changed from rev 5.0 to 5.1 */ |
| 113 | if (denali->revision < 0x0501) |
| 114 | denali->max_banks <<= 1; |
Jamie Iles | c89eeda | 2011-05-06 15:28:57 +0100 | [diff] [blame] | 115 | } |
| 116 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 117 | static void denali_enable_irq(struct denali_nand_info *denali) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 118 | { |
Jamie Iles | 9589bf5 | 2011-05-06 15:28:56 +0100 | [diff] [blame] | 119 | int i; |
| 120 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 121 | for (i = 0; i < DENALI_NR_BANKS; i++) |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 122 | iowrite32(U32_MAX, denali->reg + INTR_EN(i)); |
| 123 | iowrite32(GLOBAL_INT_EN_FLAG, denali->reg + GLOBAL_INT_ENABLE); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 124 | } |
| 125 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 126 | static void denali_disable_irq(struct denali_nand_info *denali) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 127 | { |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 128 | int i; |
| 129 | |
| 130 | for (i = 0; i < DENALI_NR_BANKS; i++) |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 131 | iowrite32(0, denali->reg + INTR_EN(i)); |
| 132 | iowrite32(0, denali->reg + GLOBAL_INT_ENABLE); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 133 | } |
| 134 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 135 | static void denali_clear_irq(struct denali_nand_info *denali, |
| 136 | int bank, uint32_t irq_status) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 137 | { |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 138 | /* write one to clear bits */ |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 139 | iowrite32(irq_status, denali->reg + INTR_STATUS(bank)); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 140 | } |
| 141 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 142 | static void denali_clear_irq_all(struct denali_nand_info *denali) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 143 | { |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 144 | int i; |
Masahiro Yamada | 5637b69 | 2014-09-09 11:01:52 +0900 | [diff] [blame] | 145 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 146 | for (i = 0; i < DENALI_NR_BANKS; i++) |
| 147 | denali_clear_irq(denali, i, U32_MAX); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 148 | } |
| 149 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 150 | static irqreturn_t denali_isr(int irq, void *dev_id) |
| 151 | { |
| 152 | struct denali_nand_info *denali = dev_id; |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 153 | irqreturn_t ret = IRQ_NONE; |
Masahiro Yamada | 5637b69 | 2014-09-09 11:01:52 +0900 | [diff] [blame] | 154 | uint32_t irq_status; |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 155 | int i; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 156 | |
| 157 | spin_lock(&denali->irq_lock); |
| 158 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 159 | for (i = 0; i < DENALI_NR_BANKS; i++) { |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 160 | irq_status = ioread32(denali->reg + INTR_STATUS(i)); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 161 | if (irq_status) |
| 162 | ret = IRQ_HANDLED; |
| 163 | |
| 164 | denali_clear_irq(denali, i, irq_status); |
| 165 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 166 | if (i != denali->active_bank) |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 167 | continue; |
| 168 | |
| 169 | denali->irq_status |= irq_status; |
| 170 | |
| 171 | if (denali->irq_status & denali->irq_mask) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 172 | complete(&denali->complete); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 173 | } |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 174 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 175 | spin_unlock(&denali->irq_lock); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 176 | |
| 177 | return ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 178 | } |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 179 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 180 | static void denali_reset_irq(struct denali_nand_info *denali) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 181 | { |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 182 | unsigned long flags; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 183 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 184 | spin_lock_irqsave(&denali->irq_lock, flags); |
| 185 | denali->irq_status = 0; |
| 186 | denali->irq_mask = 0; |
| 187 | spin_unlock_irqrestore(&denali->irq_lock, flags); |
| 188 | } |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 189 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 190 | static uint32_t denali_wait_for_irq(struct denali_nand_info *denali, |
| 191 | uint32_t irq_mask) |
| 192 | { |
| 193 | unsigned long time_left, flags; |
| 194 | uint32_t irq_status; |
Masahiro Yamada | 8125450 | 2014-09-16 20:04:25 +0900 | [diff] [blame] | 195 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 196 | spin_lock_irqsave(&denali->irq_lock, flags); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 197 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 198 | irq_status = denali->irq_status; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 199 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 200 | if (irq_mask & irq_status) { |
| 201 | /* return immediately if the IRQ has already happened. */ |
| 202 | spin_unlock_irqrestore(&denali->irq_lock, flags); |
| 203 | return irq_status; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 204 | } |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 205 | |
| 206 | denali->irq_mask = irq_mask; |
| 207 | reinit_completion(&denali->complete); |
| 208 | spin_unlock_irqrestore(&denali->irq_lock, flags); |
| 209 | |
| 210 | time_left = wait_for_completion_timeout(&denali->complete, |
| 211 | msecs_to_jiffies(1000)); |
| 212 | if (!time_left) { |
| 213 | dev_err(denali->dev, "timeout while waiting for irq 0x%x\n", |
Masahiro Yamada | fdd4d08 | 2017-09-22 12:46:42 +0900 | [diff] [blame] | 214 | irq_mask); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 215 | return 0; |
| 216 | } |
| 217 | |
| 218 | return denali->irq_status; |
| 219 | } |
| 220 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 221 | static uint32_t denali_check_irq(struct denali_nand_info *denali) |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 222 | { |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 223 | unsigned long flags; |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 224 | uint32_t irq_status; |
| 225 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 226 | spin_lock_irqsave(&denali->irq_lock, flags); |
| 227 | irq_status = denali->irq_status; |
| 228 | spin_unlock_irqrestore(&denali->irq_lock, flags); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 229 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 230 | return irq_status; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 231 | } |
| 232 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 233 | static void denali_read_buf(struct mtd_info *mtd, uint8_t *buf, int len) |
| 234 | { |
| 235 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 236 | u32 addr = DENALI_MAP11_DATA | DENALI_BANK(denali); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 237 | int i; |
| 238 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 239 | for (i = 0; i < len; i++) |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 240 | buf[i] = denali->host_read(denali, addr); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 241 | } |
| 242 | |
| 243 | static void denali_write_buf(struct mtd_info *mtd, const uint8_t *buf, int len) |
| 244 | { |
| 245 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 246 | u32 addr = DENALI_MAP11_DATA | DENALI_BANK(denali); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 247 | int i; |
| 248 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 249 | for (i = 0; i < len; i++) |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 250 | denali->host_write(denali, addr, buf[i]); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 251 | } |
| 252 | |
| 253 | static void denali_read_buf16(struct mtd_info *mtd, uint8_t *buf, int len) |
| 254 | { |
| 255 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 256 | u32 addr = DENALI_MAP11_DATA | DENALI_BANK(denali); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 257 | uint16_t *buf16 = (uint16_t *)buf; |
| 258 | int i; |
| 259 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 260 | for (i = 0; i < len / 2; i++) |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 261 | buf16[i] = denali->host_read(denali, addr); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 262 | } |
| 263 | |
| 264 | static void denali_write_buf16(struct mtd_info *mtd, const uint8_t *buf, |
| 265 | int len) |
| 266 | { |
| 267 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 268 | u32 addr = DENALI_MAP11_DATA | DENALI_BANK(denali); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 269 | const uint16_t *buf16 = (const uint16_t *)buf; |
| 270 | int i; |
| 271 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 272 | for (i = 0; i < len / 2; i++) |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 273 | denali->host_write(denali, addr, buf16[i]); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 274 | } |
| 275 | |
| 276 | static uint8_t denali_read_byte(struct mtd_info *mtd) |
| 277 | { |
| 278 | uint8_t byte; |
| 279 | |
| 280 | denali_read_buf(mtd, &byte, 1); |
| 281 | |
| 282 | return byte; |
| 283 | } |
| 284 | |
| 285 | static void denali_write_byte(struct mtd_info *mtd, uint8_t byte) |
| 286 | { |
| 287 | denali_write_buf(mtd, &byte, 1); |
| 288 | } |
| 289 | |
| 290 | static uint16_t denali_read_word(struct mtd_info *mtd) |
| 291 | { |
| 292 | uint16_t word; |
| 293 | |
| 294 | denali_read_buf16(mtd, (uint8_t *)&word, 2); |
| 295 | |
| 296 | return word; |
| 297 | } |
| 298 | |
| 299 | static void denali_cmd_ctrl(struct mtd_info *mtd, int dat, unsigned int ctrl) |
| 300 | { |
| 301 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 302 | uint32_t type; |
| 303 | |
| 304 | if (ctrl & NAND_CLE) |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 305 | type = DENALI_MAP11_CMD; |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 306 | else if (ctrl & NAND_ALE) |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 307 | type = DENALI_MAP11_ADDR; |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 308 | else |
| 309 | return; |
| 310 | |
| 311 | /* |
| 312 | * Some commands are followed by chip->dev_ready or chip->waitfunc. |
| 313 | * irq_status must be cleared here to catch the R/B# interrupt later. |
| 314 | */ |
| 315 | if (ctrl & NAND_CTRL_CHANGE) |
| 316 | denali_reset_irq(denali); |
| 317 | |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 318 | denali->host_write(denali, DENALI_BANK(denali) | type, dat); |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 319 | } |
| 320 | |
| 321 | static int denali_dev_ready(struct mtd_info *mtd) |
| 322 | { |
| 323 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 324 | |
| 325 | return !!(denali_check_irq(denali) & INTR__INT_ACT); |
| 326 | } |
| 327 | |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 328 | static int denali_check_erased_page(struct mtd_info *mtd, |
| 329 | struct nand_chip *chip, uint8_t *buf, |
| 330 | unsigned long uncor_ecc_flags, |
| 331 | unsigned int max_bitflips) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 332 | { |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 333 | uint8_t *ecc_code = chip->buffers->ecccode; |
| 334 | int ecc_steps = chip->ecc.steps; |
| 335 | int ecc_size = chip->ecc.size; |
| 336 | int ecc_bytes = chip->ecc.bytes; |
| 337 | int i, ret, stat; |
Masahiro Yamada | 8125450 | 2014-09-16 20:04:25 +0900 | [diff] [blame] | 338 | |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 339 | ret = mtd_ooblayout_get_eccbytes(mtd, ecc_code, chip->oob_poi, 0, |
| 340 | chip->ecc.total); |
| 341 | if (ret) |
| 342 | return ret; |
| 343 | |
| 344 | for (i = 0; i < ecc_steps; i++) { |
| 345 | if (!(uncor_ecc_flags & BIT(i))) |
| 346 | continue; |
| 347 | |
| 348 | stat = nand_check_erased_ecc_chunk(buf, ecc_size, |
| 349 | ecc_code, ecc_bytes, |
| 350 | NULL, 0, |
| 351 | chip->ecc.strength); |
| 352 | if (stat < 0) { |
| 353 | mtd->ecc_stats.failed++; |
| 354 | } else { |
| 355 | mtd->ecc_stats.corrected += stat; |
| 356 | max_bitflips = max_t(unsigned int, max_bitflips, stat); |
| 357 | } |
| 358 | |
| 359 | buf += ecc_size; |
| 360 | ecc_code += ecc_bytes; |
| 361 | } |
| 362 | |
| 363 | return max_bitflips; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 364 | } |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 365 | |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 366 | static int denali_hw_ecc_fixup(struct mtd_info *mtd, |
| 367 | struct denali_nand_info *denali, |
| 368 | unsigned long *uncor_ecc_flags) |
| 369 | { |
| 370 | struct nand_chip *chip = mtd_to_nand(mtd); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 371 | int bank = denali->active_bank; |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 372 | uint32_t ecc_cor; |
| 373 | unsigned int max_bitflips; |
| 374 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 375 | ecc_cor = ioread32(denali->reg + ECC_COR_INFO(bank)); |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 376 | ecc_cor >>= ECC_COR_INFO__SHIFT(bank); |
| 377 | |
| 378 | if (ecc_cor & ECC_COR_INFO__UNCOR_ERR) { |
| 379 | /* |
| 380 | * This flag is set when uncorrectable error occurs at least in |
| 381 | * one ECC sector. We can not know "how many sectors", or |
| 382 | * "which sector(s)". We need erase-page check for all sectors. |
| 383 | */ |
| 384 | *uncor_ecc_flags = GENMASK(chip->ecc.steps - 1, 0); |
| 385 | return 0; |
| 386 | } |
| 387 | |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 388 | max_bitflips = FIELD_GET(ECC_COR_INFO__MAX_ERRORS, ecc_cor); |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 389 | |
| 390 | /* |
| 391 | * The register holds the maximum of per-sector corrected bitflips. |
| 392 | * This is suitable for the return value of the ->read_page() callback. |
| 393 | * Unfortunately, we can not know the total number of corrected bits in |
| 394 | * the page. Increase the stats by max_bitflips. (compromised solution) |
| 395 | */ |
| 396 | mtd->ecc_stats.corrected += max_bitflips; |
| 397 | |
| 398 | return max_bitflips; |
| 399 | } |
| 400 | |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 401 | static int denali_sw_ecc_fixup(struct mtd_info *mtd, |
| 402 | struct denali_nand_info *denali, |
| 403 | unsigned long *uncor_ecc_flags, uint8_t *buf) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 404 | { |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 405 | unsigned int ecc_size = denali->nand.ecc.size; |
Mike Dunn | 3f91e94 | 2012-04-25 12:06:09 -0700 | [diff] [blame] | 406 | unsigned int bitflips = 0; |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 407 | unsigned int max_bitflips = 0; |
| 408 | uint32_t err_addr, err_cor_info; |
| 409 | unsigned int err_byte, err_sector, err_device; |
| 410 | uint8_t err_cor_value; |
| 411 | unsigned int prev_sector = 0; |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 412 | uint32_t irq_status; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 413 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 414 | denali_reset_irq(denali); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 415 | |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 416 | do { |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 417 | err_addr = ioread32(denali->reg + ECC_ERROR_ADDRESS); |
Masahiro Yamada | e0d53b3 | 2017-09-22 12:46:43 +0900 | [diff] [blame] | 418 | err_sector = FIELD_GET(ECC_ERROR_ADDRESS__SECTOR, err_addr); |
| 419 | err_byte = FIELD_GET(ECC_ERROR_ADDRESS__OFFSET, err_addr); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 420 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 421 | err_cor_info = ioread32(denali->reg + ERR_CORRECTION_INFO); |
Masahiro Yamada | e0d53b3 | 2017-09-22 12:46:43 +0900 | [diff] [blame] | 422 | err_cor_value = FIELD_GET(ERR_CORRECTION_INFO__BYTE, |
| 423 | err_cor_info); |
| 424 | err_device = FIELD_GET(ERR_CORRECTION_INFO__DEVICE, |
| 425 | err_cor_info); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 426 | |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 427 | /* reset the bitflip counter when crossing ECC sector */ |
| 428 | if (err_sector != prev_sector) |
| 429 | bitflips = 0; |
Masahiro Yamada | 8125450 | 2014-09-16 20:04:25 +0900 | [diff] [blame] | 430 | |
Masahiro Yamada | e0d53b3 | 2017-09-22 12:46:43 +0900 | [diff] [blame] | 431 | if (err_cor_info & ERR_CORRECTION_INFO__UNCOR) { |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 432 | /* |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 433 | * Check later if this is a real ECC error, or |
| 434 | * an erased sector. |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 435 | */ |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 436 | *uncor_ecc_flags |= BIT(err_sector); |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 437 | } else if (err_byte < ecc_size) { |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 438 | /* |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 439 | * If err_byte is larger than ecc_size, means error |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 440 | * happened in OOB, so we ignore it. It's no need for |
| 441 | * us to correct it err_device is represented the NAND |
| 442 | * error bits are happened in if there are more than |
| 443 | * one NAND connected. |
| 444 | */ |
| 445 | int offset; |
| 446 | unsigned int flips_in_byte; |
| 447 | |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 448 | offset = (err_sector * ecc_size + err_byte) * |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 449 | denali->devs_per_cs + err_device; |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 450 | |
| 451 | /* correct the ECC error */ |
| 452 | flips_in_byte = hweight8(buf[offset] ^ err_cor_value); |
| 453 | buf[offset] ^= err_cor_value; |
| 454 | mtd->ecc_stats.corrected += flips_in_byte; |
| 455 | bitflips += flips_in_byte; |
| 456 | |
| 457 | max_bitflips = max(max_bitflips, bitflips); |
| 458 | } |
| 459 | |
| 460 | prev_sector = err_sector; |
Masahiro Yamada | e0d53b3 | 2017-09-22 12:46:43 +0900 | [diff] [blame] | 461 | } while (!(err_cor_info & ERR_CORRECTION_INFO__LAST_ERR)); |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 462 | |
| 463 | /* |
Masahiro Yamada | 8582a03 | 2017-09-22 12:46:45 +0900 | [diff] [blame] | 464 | * Once handle all ECC errors, controller will trigger an |
| 465 | * ECC_TRANSACTION_DONE interrupt. |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 466 | */ |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 467 | irq_status = denali_wait_for_irq(denali, INTR__ECC_TRANSACTION_DONE); |
| 468 | if (!(irq_status & INTR__ECC_TRANSACTION_DONE)) |
| 469 | return -EIO; |
Masahiro Yamada | 20d4859 | 2017-03-30 15:45:50 +0900 | [diff] [blame] | 470 | |
| 471 | return max_bitflips; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 472 | } |
| 473 | |
Masahiro Yamada | 2291cb8 | 2017-06-13 22:45:42 +0900 | [diff] [blame] | 474 | static void denali_setup_dma64(struct denali_nand_info *denali, |
Masahiro Yamada | 96a376b | 2017-06-13 22:45:44 +0900 | [diff] [blame] | 475 | dma_addr_t dma_addr, int page, int write) |
Masahiro Yamada | 210a2c8 | 2017-03-30 15:45:54 +0900 | [diff] [blame] | 476 | { |
| 477 | uint32_t mode; |
| 478 | const int page_count = 1; |
Masahiro Yamada | 210a2c8 | 2017-03-30 15:45:54 +0900 | [diff] [blame] | 479 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 480 | mode = DENALI_MAP10 | DENALI_BANK(denali) | page; |
Masahiro Yamada | 210a2c8 | 2017-03-30 15:45:54 +0900 | [diff] [blame] | 481 | |
| 482 | /* DMA is a three step process */ |
| 483 | |
| 484 | /* |
| 485 | * 1. setup transfer type, interrupt when complete, |
| 486 | * burst len = 64 bytes, the number of pages |
| 487 | */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 488 | denali->host_write(denali, mode, |
| 489 | 0x01002000 | (64 << 16) | (write << 8) | page_count); |
Masahiro Yamada | 210a2c8 | 2017-03-30 15:45:54 +0900 | [diff] [blame] | 490 | |
| 491 | /* 2. set memory low address */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 492 | denali->host_write(denali, mode, lower_32_bits(dma_addr)); |
Masahiro Yamada | 210a2c8 | 2017-03-30 15:45:54 +0900 | [diff] [blame] | 493 | |
| 494 | /* 3. set memory high address */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 495 | denali->host_write(denali, mode, upper_32_bits(dma_addr)); |
Masahiro Yamada | 210a2c8 | 2017-03-30 15:45:54 +0900 | [diff] [blame] | 496 | } |
| 497 | |
Masahiro Yamada | 2291cb8 | 2017-06-13 22:45:42 +0900 | [diff] [blame] | 498 | static void denali_setup_dma32(struct denali_nand_info *denali, |
Masahiro Yamada | 96a376b | 2017-06-13 22:45:44 +0900 | [diff] [blame] | 499 | dma_addr_t dma_addr, int page, int write) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 500 | { |
Masahiro Yamada | 5637b69 | 2014-09-09 11:01:52 +0900 | [diff] [blame] | 501 | uint32_t mode; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 502 | const int page_count = 1; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 503 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 504 | mode = DENALI_MAP10 | DENALI_BANK(denali); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 505 | |
| 506 | /* DMA is a four step process */ |
| 507 | |
| 508 | /* 1. setup transfer type and # of pages */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 509 | denali->host_write(denali, mode | page, |
| 510 | 0x2000 | (write << 8) | page_count); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 511 | |
| 512 | /* 2. set memory high address bits 23:8 */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 513 | denali->host_write(denali, mode | ((dma_addr >> 16) << 8), 0x2200); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 514 | |
| 515 | /* 3. set memory low address bits 23:8 */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 516 | denali->host_write(denali, mode | ((dma_addr & 0xffff) << 8), 0x2300); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 517 | |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 518 | /* 4. interrupt when complete, burst len = 64 bytes */ |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 519 | denali->host_write(denali, mode | 0x14000, 0x2400); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 520 | } |
| 521 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 522 | static int denali_pio_read(struct denali_nand_info *denali, void *buf, |
| 523 | size_t size, int page, int raw) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 524 | { |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 525 | u32 addr = DENALI_MAP01 | DENALI_BANK(denali) | page; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 526 | uint32_t *buf32 = (uint32_t *)buf; |
| 527 | uint32_t irq_status, ecc_err_mask; |
| 528 | int i; |
Masahiro Yamada | b21ff82 | 2017-06-13 22:45:35 +0900 | [diff] [blame] | 529 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 530 | if (denali->caps & DENALI_CAP_HW_ECC_FIXUP) |
| 531 | ecc_err_mask = INTR__ECC_UNCOR_ERR; |
| 532 | else |
| 533 | ecc_err_mask = INTR__ECC_ERR; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 534 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 535 | denali_reset_irq(denali); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 536 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 537 | for (i = 0; i < size / 4; i++) |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 538 | *buf32++ = denali->host_read(denali, addr); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 539 | |
| 540 | irq_status = denali_wait_for_irq(denali, INTR__PAGE_XFER_INC); |
| 541 | if (!(irq_status & INTR__PAGE_XFER_INC)) |
| 542 | return -EIO; |
| 543 | |
Masahiro Yamada | 57a4d8b | 2017-06-13 22:45:46 +0900 | [diff] [blame] | 544 | if (irq_status & INTR__ERASED_PAGE) |
| 545 | memset(buf, 0xff, size); |
| 546 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 547 | return irq_status & ecc_err_mask ? -EBADMSG : 0; |
| 548 | } |
| 549 | |
| 550 | static int denali_pio_write(struct denali_nand_info *denali, |
| 551 | const void *buf, size_t size, int page, int raw) |
| 552 | { |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 553 | u32 addr = DENALI_MAP01 | DENALI_BANK(denali) | page; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 554 | const uint32_t *buf32 = (uint32_t *)buf; |
| 555 | uint32_t irq_status; |
| 556 | int i; |
| 557 | |
| 558 | denali_reset_irq(denali); |
| 559 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 560 | for (i = 0; i < size / 4; i++) |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 561 | denali->host_write(denali, addr, *buf32++); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 562 | |
| 563 | irq_status = denali_wait_for_irq(denali, |
| 564 | INTR__PROGRAM_COMP | INTR__PROGRAM_FAIL); |
| 565 | if (!(irq_status & INTR__PROGRAM_COMP)) |
| 566 | return -EIO; |
| 567 | |
| 568 | return 0; |
| 569 | } |
| 570 | |
| 571 | static int denali_pio_xfer(struct denali_nand_info *denali, void *buf, |
| 572 | size_t size, int page, int raw, int write) |
| 573 | { |
| 574 | if (write) |
| 575 | return denali_pio_write(denali, buf, size, page, raw); |
| 576 | else |
| 577 | return denali_pio_read(denali, buf, size, page, raw); |
| 578 | } |
| 579 | |
| 580 | static int denali_dma_xfer(struct denali_nand_info *denali, void *buf, |
| 581 | size_t size, int page, int raw, int write) |
| 582 | { |
Masahiro Yamada | 997cde2 | 2017-06-13 22:45:47 +0900 | [diff] [blame] | 583 | dma_addr_t dma_addr; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 584 | uint32_t irq_mask, irq_status, ecc_err_mask; |
| 585 | enum dma_data_direction dir = write ? DMA_TO_DEVICE : DMA_FROM_DEVICE; |
| 586 | int ret = 0; |
| 587 | |
Masahiro Yamada | 997cde2 | 2017-06-13 22:45:47 +0900 | [diff] [blame] | 588 | dma_addr = dma_map_single(denali->dev, buf, size, dir); |
| 589 | if (dma_mapping_error(denali->dev, dma_addr)) { |
| 590 | dev_dbg(denali->dev, "Failed to DMA-map buffer. Trying PIO.\n"); |
| 591 | return denali_pio_xfer(denali, buf, size, page, raw, write); |
| 592 | } |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 593 | |
| 594 | if (write) { |
| 595 | /* |
| 596 | * INTR__PROGRAM_COMP is never asserted for the DMA transfer. |
| 597 | * We can use INTR__DMA_CMD_COMP instead. This flag is asserted |
| 598 | * when the page program is completed. |
| 599 | */ |
| 600 | irq_mask = INTR__DMA_CMD_COMP | INTR__PROGRAM_FAIL; |
| 601 | ecc_err_mask = 0; |
| 602 | } else if (denali->caps & DENALI_CAP_HW_ECC_FIXUP) { |
| 603 | irq_mask = INTR__DMA_CMD_COMP; |
| 604 | ecc_err_mask = INTR__ECC_UNCOR_ERR; |
| 605 | } else { |
| 606 | irq_mask = INTR__DMA_CMD_COMP; |
| 607 | ecc_err_mask = INTR__ECC_ERR; |
| 608 | } |
| 609 | |
Masahiro Yamada | 586a2c5 | 2017-09-22 12:46:41 +0900 | [diff] [blame] | 610 | iowrite32(DMA_ENABLE__FLAG, denali->reg + DMA_ENABLE); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 611 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 612 | denali_reset_irq(denali); |
Masahiro Yamada | 89dcb27 | 2017-09-22 12:46:49 +0900 | [diff] [blame^] | 613 | denali->setup_dma(denali, dma_addr, page, write); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 614 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 615 | irq_status = denali_wait_for_irq(denali, irq_mask); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 616 | if (!(irq_status & INTR__DMA_CMD_COMP)) |
Masahiro Yamada | b21ff82 | 2017-06-13 22:45:35 +0900 | [diff] [blame] | 617 | ret = -EIO; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 618 | else if (irq_status & ecc_err_mask) |
| 619 | ret = -EBADMSG; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 620 | |
Masahiro Yamada | 586a2c5 | 2017-09-22 12:46:41 +0900 | [diff] [blame] | 621 | iowrite32(0, denali->reg + DMA_ENABLE); |
| 622 | |
Masahiro Yamada | 997cde2 | 2017-06-13 22:45:47 +0900 | [diff] [blame] | 623 | dma_unmap_single(denali->dev, dma_addr, size, dir); |
Josh Wu | fdbad98d | 2012-06-25 18:07:45 +0800 | [diff] [blame] | 624 | |
Masahiro Yamada | 57a4d8b | 2017-06-13 22:45:46 +0900 | [diff] [blame] | 625 | if (irq_status & INTR__ERASED_PAGE) |
| 626 | memset(buf, 0xff, size); |
| 627 | |
Masahiro Yamada | b21ff82 | 2017-06-13 22:45:35 +0900 | [diff] [blame] | 628 | return ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 629 | } |
| 630 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 631 | static int denali_data_xfer(struct denali_nand_info *denali, void *buf, |
| 632 | size_t size, int page, int raw, int write) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 633 | { |
Masahiro Yamada | ee0ae6a | 2017-09-22 12:46:38 +0900 | [diff] [blame] | 634 | iowrite32(raw ? 0 : ECC_ENABLE__FLAG, denali->reg + ECC_ENABLE); |
| 635 | iowrite32(raw ? TRANSFER_SPARE_REG__FLAG : 0, |
| 636 | denali->reg + TRANSFER_SPARE_REG); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 637 | |
| 638 | if (denali->dma_avail) |
| 639 | return denali_dma_xfer(denali, buf, size, page, raw, write); |
| 640 | else |
| 641 | return denali_pio_xfer(denali, buf, size, page, raw, write); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 642 | } |
| 643 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 644 | static void denali_oob_xfer(struct mtd_info *mtd, struct nand_chip *chip, |
| 645 | int page, int write) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 646 | { |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 647 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 648 | unsigned int start_cmd = write ? NAND_CMD_SEQIN : NAND_CMD_READ0; |
| 649 | unsigned int rnd_cmd = write ? NAND_CMD_RNDIN : NAND_CMD_RNDOUT; |
| 650 | int writesize = mtd->writesize; |
| 651 | int oobsize = mtd->oobsize; |
| 652 | uint8_t *bufpoi = chip->oob_poi; |
| 653 | int ecc_steps = chip->ecc.steps; |
| 654 | int ecc_size = chip->ecc.size; |
| 655 | int ecc_bytes = chip->ecc.bytes; |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 656 | int oob_skip = denali->oob_skip_bytes; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 657 | size_t size = writesize + oobsize; |
| 658 | int i, pos, len; |
| 659 | |
| 660 | /* BBM at the beginning of the OOB area */ |
| 661 | chip->cmdfunc(mtd, start_cmd, writesize, page); |
| 662 | if (write) |
| 663 | chip->write_buf(mtd, bufpoi, oob_skip); |
| 664 | else |
| 665 | chip->read_buf(mtd, bufpoi, oob_skip); |
| 666 | bufpoi += oob_skip; |
| 667 | |
| 668 | /* OOB ECC */ |
| 669 | for (i = 0; i < ecc_steps; i++) { |
| 670 | pos = ecc_size + i * (ecc_size + ecc_bytes); |
| 671 | len = ecc_bytes; |
| 672 | |
| 673 | if (pos >= writesize) |
| 674 | pos += oob_skip; |
| 675 | else if (pos + len > writesize) |
| 676 | len = writesize - pos; |
| 677 | |
| 678 | chip->cmdfunc(mtd, rnd_cmd, pos, -1); |
| 679 | if (write) |
| 680 | chip->write_buf(mtd, bufpoi, len); |
| 681 | else |
| 682 | chip->read_buf(mtd, bufpoi, len); |
| 683 | bufpoi += len; |
| 684 | if (len < ecc_bytes) { |
| 685 | len = ecc_bytes - len; |
| 686 | chip->cmdfunc(mtd, rnd_cmd, writesize + oob_skip, -1); |
| 687 | if (write) |
| 688 | chip->write_buf(mtd, bufpoi, len); |
| 689 | else |
| 690 | chip->read_buf(mtd, bufpoi, len); |
| 691 | bufpoi += len; |
| 692 | } |
| 693 | } |
| 694 | |
| 695 | /* OOB free */ |
| 696 | len = oobsize - (bufpoi - chip->oob_poi); |
| 697 | chip->cmdfunc(mtd, rnd_cmd, size - len, -1); |
| 698 | if (write) |
| 699 | chip->write_buf(mtd, bufpoi, len); |
| 700 | else |
| 701 | chip->read_buf(mtd, bufpoi, len); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 702 | } |
| 703 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 704 | static int denali_read_page_raw(struct mtd_info *mtd, struct nand_chip *chip, |
| 705 | uint8_t *buf, int oob_required, int page) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 706 | { |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 707 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 708 | int writesize = mtd->writesize; |
| 709 | int oobsize = mtd->oobsize; |
| 710 | int ecc_steps = chip->ecc.steps; |
| 711 | int ecc_size = chip->ecc.size; |
| 712 | int ecc_bytes = chip->ecc.bytes; |
| 713 | void *dma_buf = denali->buf; |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 714 | int oob_skip = denali->oob_skip_bytes; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 715 | size_t size = writesize + oobsize; |
| 716 | int ret, i, pos, len; |
| 717 | |
| 718 | ret = denali_data_xfer(denali, dma_buf, size, page, 1, 0); |
| 719 | if (ret) |
| 720 | return ret; |
| 721 | |
| 722 | /* Arrange the buffer for syndrome payload/ecc layout */ |
| 723 | if (buf) { |
| 724 | for (i = 0; i < ecc_steps; i++) { |
| 725 | pos = i * (ecc_size + ecc_bytes); |
| 726 | len = ecc_size; |
| 727 | |
| 728 | if (pos >= writesize) |
| 729 | pos += oob_skip; |
| 730 | else if (pos + len > writesize) |
| 731 | len = writesize - pos; |
| 732 | |
| 733 | memcpy(buf, dma_buf + pos, len); |
| 734 | buf += len; |
| 735 | if (len < ecc_size) { |
| 736 | len = ecc_size - len; |
| 737 | memcpy(buf, dma_buf + writesize + oob_skip, |
| 738 | len); |
| 739 | buf += len; |
| 740 | } |
| 741 | } |
| 742 | } |
| 743 | |
| 744 | if (oob_required) { |
| 745 | uint8_t *oob = chip->oob_poi; |
| 746 | |
| 747 | /* BBM at the beginning of the OOB area */ |
| 748 | memcpy(oob, dma_buf + writesize, oob_skip); |
| 749 | oob += oob_skip; |
| 750 | |
| 751 | /* OOB ECC */ |
| 752 | for (i = 0; i < ecc_steps; i++) { |
| 753 | pos = ecc_size + i * (ecc_size + ecc_bytes); |
| 754 | len = ecc_bytes; |
| 755 | |
| 756 | if (pos >= writesize) |
| 757 | pos += oob_skip; |
| 758 | else if (pos + len > writesize) |
| 759 | len = writesize - pos; |
| 760 | |
| 761 | memcpy(oob, dma_buf + pos, len); |
| 762 | oob += len; |
| 763 | if (len < ecc_bytes) { |
| 764 | len = ecc_bytes - len; |
| 765 | memcpy(oob, dma_buf + writesize + oob_skip, |
| 766 | len); |
| 767 | oob += len; |
| 768 | } |
| 769 | } |
| 770 | |
| 771 | /* OOB free */ |
| 772 | len = oobsize - (oob - chip->oob_poi); |
| 773 | memcpy(oob, dma_buf + size - len, len); |
| 774 | } |
| 775 | |
| 776 | return 0; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 777 | } |
| 778 | |
Chuanxiao | 5bac3ac | 2010-08-05 23:06:04 +0800 | [diff] [blame] | 779 | static int denali_read_oob(struct mtd_info *mtd, struct nand_chip *chip, |
Shmulik Ladkani | 5c2ffb1 | 2012-05-09 13:06:35 +0300 | [diff] [blame] | 780 | int page) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 781 | { |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 782 | denali_oob_xfer(mtd, chip, page, 0); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 783 | |
Shmulik Ladkani | 5c2ffb1 | 2012-05-09 13:06:35 +0300 | [diff] [blame] | 784 | return 0; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 785 | } |
| 786 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 787 | static int denali_write_oob(struct mtd_info *mtd, struct nand_chip *chip, |
| 788 | int page) |
| 789 | { |
| 790 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 791 | int status; |
| 792 | |
| 793 | denali_reset_irq(denali); |
| 794 | |
| 795 | denali_oob_xfer(mtd, chip, page, 1); |
| 796 | |
| 797 | chip->cmdfunc(mtd, NAND_CMD_PAGEPROG, -1, -1); |
| 798 | status = chip->waitfunc(mtd, chip); |
| 799 | |
| 800 | return status & NAND_STATUS_FAIL ? -EIO : 0; |
| 801 | } |
| 802 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 803 | static int denali_read_page(struct mtd_info *mtd, struct nand_chip *chip, |
Brian Norris | 1fbb938 | 2012-05-02 10:14:55 -0700 | [diff] [blame] | 804 | uint8_t *buf, int oob_required, int page) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 805 | { |
| 806 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 807 | unsigned long uncor_ecc_flags = 0; |
| 808 | int stat = 0; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 809 | int ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 810 | |
Masahiro Yamada | 997cde2 | 2017-06-13 22:45:47 +0900 | [diff] [blame] | 811 | ret = denali_data_xfer(denali, buf, mtd->writesize, page, 0, 0); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 812 | if (ret && ret != -EBADMSG) |
| 813 | return ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 814 | |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 815 | if (denali->caps & DENALI_CAP_HW_ECC_FIXUP) |
| 816 | stat = denali_hw_ecc_fixup(mtd, denali, &uncor_ecc_flags); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 817 | else if (ret == -EBADMSG) |
Masahiro Yamada | 24715c7 | 2017-03-30 15:45:52 +0900 | [diff] [blame] | 818 | stat = denali_sw_ecc_fixup(mtd, denali, &uncor_ecc_flags, buf); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 819 | |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 820 | if (stat < 0) |
| 821 | return stat; |
| 822 | |
| 823 | if (uncor_ecc_flags) { |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 824 | ret = denali_read_oob(mtd, chip, page); |
| 825 | if (ret) |
| 826 | return ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 827 | |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 828 | stat = denali_check_erased_page(mtd, chip, buf, |
| 829 | uncor_ecc_flags, stat); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 830 | } |
Masahiro Yamada | d29109b | 2017-03-30 15:45:51 +0900 | [diff] [blame] | 831 | |
| 832 | return stat; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 833 | } |
| 834 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 835 | static int denali_write_page_raw(struct mtd_info *mtd, struct nand_chip *chip, |
| 836 | const uint8_t *buf, int oob_required, int page) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 837 | { |
| 838 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 839 | int writesize = mtd->writesize; |
| 840 | int oobsize = mtd->oobsize; |
| 841 | int ecc_steps = chip->ecc.steps; |
| 842 | int ecc_size = chip->ecc.size; |
| 843 | int ecc_bytes = chip->ecc.bytes; |
| 844 | void *dma_buf = denali->buf; |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 845 | int oob_skip = denali->oob_skip_bytes; |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 846 | size_t size = writesize + oobsize; |
| 847 | int i, pos, len; |
Chuanxiao | 5bac3ac | 2010-08-05 23:06:04 +0800 | [diff] [blame] | 848 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 849 | /* |
| 850 | * Fill the buffer with 0xff first except the full page transfer. |
| 851 | * This simplifies the logic. |
| 852 | */ |
| 853 | if (!buf || !oob_required) |
| 854 | memset(dma_buf, 0xff, size); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 855 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 856 | /* Arrange the buffer for syndrome payload/ecc layout */ |
| 857 | if (buf) { |
| 858 | for (i = 0; i < ecc_steps; i++) { |
| 859 | pos = i * (ecc_size + ecc_bytes); |
| 860 | len = ecc_size; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 861 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 862 | if (pos >= writesize) |
| 863 | pos += oob_skip; |
| 864 | else if (pos + len > writesize) |
| 865 | len = writesize - pos; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 866 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 867 | memcpy(dma_buf + pos, buf, len); |
| 868 | buf += len; |
| 869 | if (len < ecc_size) { |
| 870 | len = ecc_size - len; |
| 871 | memcpy(dma_buf + writesize + oob_skip, buf, |
| 872 | len); |
| 873 | buf += len; |
| 874 | } |
| 875 | } |
| 876 | } |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 877 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 878 | if (oob_required) { |
| 879 | const uint8_t *oob = chip->oob_poi; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 880 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 881 | /* BBM at the beginning of the OOB area */ |
| 882 | memcpy(dma_buf + writesize, oob, oob_skip); |
| 883 | oob += oob_skip; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 884 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 885 | /* OOB ECC */ |
| 886 | for (i = 0; i < ecc_steps; i++) { |
| 887 | pos = ecc_size + i * (ecc_size + ecc_bytes); |
| 888 | len = ecc_bytes; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 889 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 890 | if (pos >= writesize) |
| 891 | pos += oob_skip; |
| 892 | else if (pos + len > writesize) |
| 893 | len = writesize - pos; |
| 894 | |
| 895 | memcpy(dma_buf + pos, oob, len); |
| 896 | oob += len; |
| 897 | if (len < ecc_bytes) { |
| 898 | len = ecc_bytes - len; |
| 899 | memcpy(dma_buf + writesize + oob_skip, oob, |
| 900 | len); |
| 901 | oob += len; |
| 902 | } |
| 903 | } |
| 904 | |
| 905 | /* OOB free */ |
| 906 | len = oobsize - (oob - chip->oob_poi); |
| 907 | memcpy(dma_buf + size - len, oob, len); |
| 908 | } |
| 909 | |
| 910 | return denali_data_xfer(denali, dma_buf, size, page, 1, 1); |
| 911 | } |
| 912 | |
| 913 | static int denali_write_page(struct mtd_info *mtd, struct nand_chip *chip, |
| 914 | const uint8_t *buf, int oob_required, int page) |
| 915 | { |
| 916 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 917 | |
Masahiro Yamada | 997cde2 | 2017-06-13 22:45:47 +0900 | [diff] [blame] | 918 | return denali_data_xfer(denali, (void *)buf, mtd->writesize, |
| 919 | page, 0, 1); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 920 | } |
| 921 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 922 | static void denali_select_chip(struct mtd_info *mtd, int chip) |
| 923 | { |
| 924 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Chuanxiao Dong | 7cfffac | 2010-08-10 00:16:51 +0800 | [diff] [blame] | 925 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 926 | denali->active_bank = chip; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 927 | } |
| 928 | |
| 929 | static int denali_waitfunc(struct mtd_info *mtd, struct nand_chip *chip) |
| 930 | { |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 931 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 932 | uint32_t irq_status; |
| 933 | |
| 934 | /* R/B# pin transitioned from low to high? */ |
| 935 | irq_status = denali_wait_for_irq(denali, INTR__INT_ACT); |
| 936 | |
| 937 | return irq_status & INTR__INT_ACT ? 0 : NAND_STATUS_FAIL; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 938 | } |
| 939 | |
Brian Norris | 49c50b9 | 2014-05-06 16:02:19 -0700 | [diff] [blame] | 940 | static int denali_erase(struct mtd_info *mtd, int page) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 941 | { |
| 942 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 943 | uint32_t irq_status; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 944 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 945 | denali_reset_irq(denali); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 946 | |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 947 | denali->host_write(denali, DENALI_MAP10 | DENALI_BANK(denali) | page, |
| 948 | DENALI_ERASE); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 949 | |
| 950 | /* wait for erase to complete or failure to occur */ |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 951 | irq_status = denali_wait_for_irq(denali, |
| 952 | INTR__ERASE_COMP | INTR__ERASE_FAIL); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 953 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 954 | return irq_status & INTR__ERASE_COMP ? 0 : NAND_STATUS_FAIL; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 955 | } |
| 956 | |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 957 | static int denali_setup_data_interface(struct mtd_info *mtd, int chipnr, |
| 958 | const struct nand_data_interface *conf) |
| 959 | { |
| 960 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 961 | const struct nand_sdr_timings *timings; |
| 962 | unsigned long t_clk; |
| 963 | int acc_clks, re_2_we, re_2_re, we_2_re, addr_2_data; |
| 964 | int rdwr_en_lo, rdwr_en_hi, rdwr_en_lo_hi, cs_setup; |
| 965 | int addr_2_data_mask; |
| 966 | uint32_t tmp; |
| 967 | |
| 968 | timings = nand_get_sdr_timings(conf); |
| 969 | if (IS_ERR(timings)) |
| 970 | return PTR_ERR(timings); |
| 971 | |
| 972 | /* clk_x period in picoseconds */ |
| 973 | t_clk = DIV_ROUND_DOWN_ULL(1000000000000ULL, denali->clk_x_rate); |
| 974 | if (!t_clk) |
| 975 | return -EINVAL; |
| 976 | |
| 977 | if (chipnr == NAND_DATA_IFACE_CHECK_ONLY) |
| 978 | return 0; |
| 979 | |
| 980 | /* tREA -> ACC_CLKS */ |
| 981 | acc_clks = DIV_ROUND_UP(timings->tREA_max, t_clk); |
| 982 | acc_clks = min_t(int, acc_clks, ACC_CLKS__VALUE); |
| 983 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 984 | tmp = ioread32(denali->reg + ACC_CLKS); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 985 | tmp &= ~ACC_CLKS__VALUE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 986 | tmp |= FIELD_PREP(ACC_CLKS__VALUE, acc_clks); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 987 | iowrite32(tmp, denali->reg + ACC_CLKS); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 988 | |
| 989 | /* tRWH -> RE_2_WE */ |
| 990 | re_2_we = DIV_ROUND_UP(timings->tRHW_min, t_clk); |
| 991 | re_2_we = min_t(int, re_2_we, RE_2_WE__VALUE); |
| 992 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 993 | tmp = ioread32(denali->reg + RE_2_WE); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 994 | tmp &= ~RE_2_WE__VALUE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 995 | tmp |= FIELD_PREP(RE_2_WE__VALUE, re_2_we); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 996 | iowrite32(tmp, denali->reg + RE_2_WE); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 997 | |
| 998 | /* tRHZ -> RE_2_RE */ |
| 999 | re_2_re = DIV_ROUND_UP(timings->tRHZ_max, t_clk); |
| 1000 | re_2_re = min_t(int, re_2_re, RE_2_RE__VALUE); |
| 1001 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1002 | tmp = ioread32(denali->reg + RE_2_RE); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1003 | tmp &= ~RE_2_RE__VALUE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 1004 | tmp |= FIELD_PREP(RE_2_RE__VALUE, re_2_re); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1005 | iowrite32(tmp, denali->reg + RE_2_RE); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1006 | |
| 1007 | /* tWHR -> WE_2_RE */ |
| 1008 | we_2_re = DIV_ROUND_UP(timings->tWHR_min, t_clk); |
| 1009 | we_2_re = min_t(int, we_2_re, TWHR2_AND_WE_2_RE__WE_2_RE); |
| 1010 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1011 | tmp = ioread32(denali->reg + TWHR2_AND_WE_2_RE); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1012 | tmp &= ~TWHR2_AND_WE_2_RE__WE_2_RE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 1013 | tmp |= FIELD_PREP(TWHR2_AND_WE_2_RE__WE_2_RE, we_2_re); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1014 | iowrite32(tmp, denali->reg + TWHR2_AND_WE_2_RE); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1015 | |
| 1016 | /* tADL -> ADDR_2_DATA */ |
| 1017 | |
| 1018 | /* for older versions, ADDR_2_DATA is only 6 bit wide */ |
| 1019 | addr_2_data_mask = TCWAW_AND_ADDR_2_DATA__ADDR_2_DATA; |
| 1020 | if (denali->revision < 0x0501) |
| 1021 | addr_2_data_mask >>= 1; |
| 1022 | |
| 1023 | addr_2_data = DIV_ROUND_UP(timings->tADL_min, t_clk); |
| 1024 | addr_2_data = min_t(int, addr_2_data, addr_2_data_mask); |
| 1025 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1026 | tmp = ioread32(denali->reg + TCWAW_AND_ADDR_2_DATA); |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 1027 | tmp &= ~TCWAW_AND_ADDR_2_DATA__ADDR_2_DATA; |
| 1028 | tmp |= FIELD_PREP(TCWAW_AND_ADDR_2_DATA__ADDR_2_DATA, addr_2_data); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1029 | iowrite32(tmp, denali->reg + TCWAW_AND_ADDR_2_DATA); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1030 | |
| 1031 | /* tREH, tWH -> RDWR_EN_HI_CNT */ |
| 1032 | rdwr_en_hi = DIV_ROUND_UP(max(timings->tREH_min, timings->tWH_min), |
| 1033 | t_clk); |
| 1034 | rdwr_en_hi = min_t(int, rdwr_en_hi, RDWR_EN_HI_CNT__VALUE); |
| 1035 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1036 | tmp = ioread32(denali->reg + RDWR_EN_HI_CNT); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1037 | tmp &= ~RDWR_EN_HI_CNT__VALUE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 1038 | tmp |= FIELD_PREP(RDWR_EN_HI_CNT__VALUE, rdwr_en_hi); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1039 | iowrite32(tmp, denali->reg + RDWR_EN_HI_CNT); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1040 | |
| 1041 | /* tRP, tWP -> RDWR_EN_LO_CNT */ |
| 1042 | rdwr_en_lo = DIV_ROUND_UP(max(timings->tRP_min, timings->tWP_min), |
| 1043 | t_clk); |
| 1044 | rdwr_en_lo_hi = DIV_ROUND_UP(max(timings->tRC_min, timings->tWC_min), |
| 1045 | t_clk); |
| 1046 | rdwr_en_lo_hi = max(rdwr_en_lo_hi, DENALI_CLK_X_MULT); |
| 1047 | rdwr_en_lo = max(rdwr_en_lo, rdwr_en_lo_hi - rdwr_en_hi); |
| 1048 | rdwr_en_lo = min_t(int, rdwr_en_lo, RDWR_EN_LO_CNT__VALUE); |
| 1049 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1050 | tmp = ioread32(denali->reg + RDWR_EN_LO_CNT); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1051 | tmp &= ~RDWR_EN_LO_CNT__VALUE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 1052 | tmp |= FIELD_PREP(RDWR_EN_LO_CNT__VALUE, rdwr_en_lo); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1053 | iowrite32(tmp, denali->reg + RDWR_EN_LO_CNT); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1054 | |
| 1055 | /* tCS, tCEA -> CS_SETUP_CNT */ |
| 1056 | cs_setup = max3((int)DIV_ROUND_UP(timings->tCS_min, t_clk) - rdwr_en_lo, |
| 1057 | (int)DIV_ROUND_UP(timings->tCEA_max, t_clk) - acc_clks, |
| 1058 | 0); |
| 1059 | cs_setup = min_t(int, cs_setup, CS_SETUP_CNT__VALUE); |
| 1060 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1061 | tmp = ioread32(denali->reg + CS_SETUP_CNT); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1062 | tmp &= ~CS_SETUP_CNT__VALUE; |
Masahiro Yamada | 8e4cbf7 | 2017-09-22 12:46:44 +0900 | [diff] [blame] | 1063 | tmp |= FIELD_PREP(CS_SETUP_CNT__VALUE, cs_setup); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1064 | iowrite32(tmp, denali->reg + CS_SETUP_CNT); |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1065 | |
| 1066 | return 0; |
| 1067 | } |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1068 | |
Masahiro Yamada | f486287 | 2017-06-13 22:45:40 +0900 | [diff] [blame] | 1069 | static void denali_reset_banks(struct denali_nand_info *denali) |
| 1070 | { |
Masahiro Yamada | d49f579 | 2017-06-13 22:45:41 +0900 | [diff] [blame] | 1071 | u32 irq_status; |
Masahiro Yamada | f486287 | 2017-06-13 22:45:40 +0900 | [diff] [blame] | 1072 | int i; |
| 1073 | |
Masahiro Yamada | f486287 | 2017-06-13 22:45:40 +0900 | [diff] [blame] | 1074 | for (i = 0; i < denali->max_banks; i++) { |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1075 | denali->active_bank = i; |
Masahiro Yamada | d49f579 | 2017-06-13 22:45:41 +0900 | [diff] [blame] | 1076 | |
| 1077 | denali_reset_irq(denali); |
| 1078 | |
| 1079 | iowrite32(DEVICE_RESET__BANK(i), |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1080 | denali->reg + DEVICE_RESET); |
Masahiro Yamada | d49f579 | 2017-06-13 22:45:41 +0900 | [diff] [blame] | 1081 | |
| 1082 | irq_status = denali_wait_for_irq(denali, |
| 1083 | INTR__RST_COMP | INTR__INT_ACT | INTR__TIME_OUT); |
| 1084 | if (!(irq_status & INTR__INT_ACT)) |
Masahiro Yamada | f486287 | 2017-06-13 22:45:40 +0900 | [diff] [blame] | 1085 | break; |
| 1086 | } |
| 1087 | |
| 1088 | dev_dbg(denali->dev, "%d chips connected\n", i); |
| 1089 | denali->max_banks = i; |
Masahiro Yamada | f486287 | 2017-06-13 22:45:40 +0900 | [diff] [blame] | 1090 | } |
| 1091 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1092 | static void denali_hw_init(struct denali_nand_info *denali) |
| 1093 | { |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 1094 | /* |
Masahiro Yamada | e7beeee | 2017-03-30 15:45:57 +0900 | [diff] [blame] | 1095 | * The REVISION register may not be reliable. Platforms are allowed to |
| 1096 | * override it. |
| 1097 | */ |
| 1098 | if (!denali->revision) |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1099 | denali->revision = swab16(ioread32(denali->reg + REVISION)); |
Masahiro Yamada | e7beeee | 2017-03-30 15:45:57 +0900 | [diff] [blame] | 1100 | |
| 1101 | /* |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 1102 | * tell driver how many bit controller will skip before |
Chuanxiao Dong | db9a3210 | 2010-08-06 18:02:03 +0800 | [diff] [blame] | 1103 | * writing ECC code in OOB, this register may be already |
| 1104 | * set by firmware. So we read this value out. |
| 1105 | * if this value is 0, just let it be. |
Masahiro Yamada | 43914a2 | 2014-09-09 11:01:51 +0900 | [diff] [blame] | 1106 | */ |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1107 | denali->oob_skip_bytes = ioread32(denali->reg + SPARE_AREA_SKIP_BYTES); |
Masahiro Yamada | 3ac6c71 | 2017-09-22 12:46:39 +0900 | [diff] [blame] | 1108 | denali_detect_max_banks(denali); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1109 | iowrite32(0x0F, denali->reg + RB_PIN_ENABLED); |
| 1110 | iowrite32(CHIP_EN_DONT_CARE__FLAG, denali->reg + CHIP_ENABLE_DONT_CARE); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1111 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1112 | iowrite32(0xffff, denali->reg + SPARE_AREA_MARKER); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1113 | } |
| 1114 | |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1115 | int denali_calc_ecc_bytes(int step_size, int strength) |
| 1116 | { |
| 1117 | /* BCH code. Denali requires ecc.bytes to be multiple of 2 */ |
| 1118 | return DIV_ROUND_UP(strength * fls(step_size * 8), 16) * 2; |
| 1119 | } |
| 1120 | EXPORT_SYMBOL(denali_calc_ecc_bytes); |
| 1121 | |
| 1122 | static int denali_ecc_setup(struct mtd_info *mtd, struct nand_chip *chip, |
| 1123 | struct denali_nand_info *denali) |
| 1124 | { |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1125 | int oobavail = mtd->oobsize - denali->oob_skip_bytes; |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1126 | int ret; |
| 1127 | |
| 1128 | /* |
| 1129 | * If .size and .strength are already set (usually by DT), |
| 1130 | * check if they are supported by this controller. |
| 1131 | */ |
| 1132 | if (chip->ecc.size && chip->ecc.strength) |
| 1133 | return nand_check_ecc_caps(chip, denali->ecc_caps, oobavail); |
| 1134 | |
| 1135 | /* |
| 1136 | * We want .size and .strength closest to the chip's requirement |
| 1137 | * unless NAND_ECC_MAXIMIZE is requested. |
| 1138 | */ |
| 1139 | if (!(chip->ecc.options & NAND_ECC_MAXIMIZE)) { |
| 1140 | ret = nand_match_ecc_req(chip, denali->ecc_caps, oobavail); |
| 1141 | if (!ret) |
| 1142 | return 0; |
| 1143 | } |
| 1144 | |
| 1145 | /* Max ECC strength is the last thing we can do */ |
| 1146 | return nand_maximize_ecc(chip, denali->ecc_caps, oobavail); |
| 1147 | } |
Boris Brezillon | 14fad62 | 2016-02-03 20:00:11 +0100 | [diff] [blame] | 1148 | |
| 1149 | static int denali_ooblayout_ecc(struct mtd_info *mtd, int section, |
| 1150 | struct mtd_oob_region *oobregion) |
| 1151 | { |
| 1152 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 1153 | struct nand_chip *chip = mtd_to_nand(mtd); |
| 1154 | |
| 1155 | if (section) |
| 1156 | return -ERANGE; |
| 1157 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1158 | oobregion->offset = denali->oob_skip_bytes; |
Boris Brezillon | 14fad62 | 2016-02-03 20:00:11 +0100 | [diff] [blame] | 1159 | oobregion->length = chip->ecc.total; |
| 1160 | |
| 1161 | return 0; |
| 1162 | } |
| 1163 | |
| 1164 | static int denali_ooblayout_free(struct mtd_info *mtd, int section, |
| 1165 | struct mtd_oob_region *oobregion) |
| 1166 | { |
| 1167 | struct denali_nand_info *denali = mtd_to_denali(mtd); |
| 1168 | struct nand_chip *chip = mtd_to_nand(mtd); |
| 1169 | |
| 1170 | if (section) |
| 1171 | return -ERANGE; |
| 1172 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1173 | oobregion->offset = chip->ecc.total + denali->oob_skip_bytes; |
Boris Brezillon | 14fad62 | 2016-02-03 20:00:11 +0100 | [diff] [blame] | 1174 | oobregion->length = mtd->oobsize - oobregion->offset; |
| 1175 | |
| 1176 | return 0; |
| 1177 | } |
| 1178 | |
| 1179 | static const struct mtd_ooblayout_ops denali_ooblayout_ops = { |
| 1180 | .ecc = denali_ooblayout_ecc, |
| 1181 | .free = denali_ooblayout_free, |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1182 | }; |
| 1183 | |
Masahiro Yamada | e93c164 | 2017-03-23 05:07:21 +0900 | [diff] [blame] | 1184 | static int denali_multidev_fixup(struct denali_nand_info *denali) |
Masahiro Yamada | 6da27b4 | 2017-03-23 05:07:20 +0900 | [diff] [blame] | 1185 | { |
| 1186 | struct nand_chip *chip = &denali->nand; |
| 1187 | struct mtd_info *mtd = nand_to_mtd(chip); |
| 1188 | |
| 1189 | /* |
| 1190 | * Support for multi device: |
| 1191 | * When the IP configuration is x16 capable and two x8 chips are |
| 1192 | * connected in parallel, DEVICES_CONNECTED should be set to 2. |
| 1193 | * In this case, the core framework knows nothing about this fact, |
| 1194 | * so we should tell it the _logical_ pagesize and anything necessary. |
| 1195 | */ |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1196 | denali->devs_per_cs = ioread32(denali->reg + DEVICES_CONNECTED); |
Masahiro Yamada | 6da27b4 | 2017-03-23 05:07:20 +0900 | [diff] [blame] | 1197 | |
Masahiro Yamada | cc5d803 | 2017-03-23 05:07:22 +0900 | [diff] [blame] | 1198 | /* |
| 1199 | * On some SoCs, DEVICES_CONNECTED is not auto-detected. |
| 1200 | * For those, DEVICES_CONNECTED is left to 0. Set 1 if it is the case. |
| 1201 | */ |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1202 | if (denali->devs_per_cs == 0) { |
| 1203 | denali->devs_per_cs = 1; |
| 1204 | iowrite32(1, denali->reg + DEVICES_CONNECTED); |
Masahiro Yamada | cc5d803 | 2017-03-23 05:07:22 +0900 | [diff] [blame] | 1205 | } |
| 1206 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1207 | if (denali->devs_per_cs == 1) |
Masahiro Yamada | e93c164 | 2017-03-23 05:07:21 +0900 | [diff] [blame] | 1208 | return 0; |
| 1209 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1210 | if (denali->devs_per_cs != 2) { |
Masahiro Yamada | e93c164 | 2017-03-23 05:07:21 +0900 | [diff] [blame] | 1211 | dev_err(denali->dev, "unsupported number of devices %d\n", |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1212 | denali->devs_per_cs); |
Masahiro Yamada | e93c164 | 2017-03-23 05:07:21 +0900 | [diff] [blame] | 1213 | return -EINVAL; |
| 1214 | } |
| 1215 | |
| 1216 | /* 2 chips in parallel */ |
| 1217 | mtd->size <<= 1; |
| 1218 | mtd->erasesize <<= 1; |
| 1219 | mtd->writesize <<= 1; |
| 1220 | mtd->oobsize <<= 1; |
| 1221 | chip->chipsize <<= 1; |
| 1222 | chip->page_shift += 1; |
| 1223 | chip->phys_erase_shift += 1; |
| 1224 | chip->bbt_erase_shift += 1; |
| 1225 | chip->chip_shift += 1; |
| 1226 | chip->pagemask <<= 1; |
| 1227 | chip->ecc.size <<= 1; |
| 1228 | chip->ecc.bytes <<= 1; |
| 1229 | chip->ecc.strength <<= 1; |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1230 | denali->oob_skip_bytes <<= 1; |
Masahiro Yamada | e93c164 | 2017-03-23 05:07:21 +0900 | [diff] [blame] | 1231 | |
| 1232 | return 0; |
Masahiro Yamada | 6da27b4 | 2017-03-23 05:07:20 +0900 | [diff] [blame] | 1233 | } |
| 1234 | |
Dinh Nguyen | 2a0a288 | 2012-09-27 10:58:05 -0600 | [diff] [blame] | 1235 | int denali_init(struct denali_nand_info *denali) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1236 | { |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1237 | struct nand_chip *chip = &denali->nand; |
| 1238 | struct mtd_info *mtd = nand_to_mtd(chip); |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 1239 | u32 features = ioread32(denali->reg + FEATURES); |
Dinh Nguyen | 2a0a288 | 2012-09-27 10:58:05 -0600 | [diff] [blame] | 1240 | int ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1241 | |
Boris BREZILLON | 442f201b | 2015-12-11 15:06:00 +0100 | [diff] [blame] | 1242 | mtd->dev.parent = denali->dev; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1243 | denali_hw_init(denali); |
Masahiro Yamada | 8582a03 | 2017-09-22 12:46:45 +0900 | [diff] [blame] | 1244 | |
| 1245 | init_completion(&denali->complete); |
| 1246 | spin_lock_init(&denali->irq_lock); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1247 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1248 | denali_clear_irq_all(denali); |
| 1249 | |
Masahiro Yamada | 7ebb8d0 | 2016-11-09 13:35:27 +0900 | [diff] [blame] | 1250 | ret = devm_request_irq(denali->dev, denali->irq, denali_isr, |
| 1251 | IRQF_SHARED, DENALI_NAND_NAME, denali); |
| 1252 | if (ret) { |
Masahiro Yamada | 789ccf1 | 2016-11-09 13:35:24 +0900 | [diff] [blame] | 1253 | dev_err(denali->dev, "Unable to request IRQ\n"); |
Masahiro Yamada | 7ebb8d0 | 2016-11-09 13:35:27 +0900 | [diff] [blame] | 1254 | return ret; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1255 | } |
| 1256 | |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1257 | denali_enable_irq(denali); |
Masahiro Yamada | d49f579 | 2017-06-13 22:45:41 +0900 | [diff] [blame] | 1258 | denali_reset_banks(denali); |
| 1259 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1260 | denali->active_bank = DENALI_INVALID_BANK; |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1261 | |
Masahiro Yamada | 63757d4 | 2017-03-23 05:07:18 +0900 | [diff] [blame] | 1262 | nand_set_flash_node(chip, denali->dev->of_node); |
Masahiro Yamada | 8aabdf3 | 2017-03-30 15:45:48 +0900 | [diff] [blame] | 1263 | /* Fallback to the default name if DT did not give "label" property */ |
| 1264 | if (!mtd->name) |
| 1265 | mtd->name = "denali-nand"; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1266 | |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1267 | chip->select_chip = denali_select_chip; |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1268 | chip->read_byte = denali_read_byte; |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 1269 | chip->write_byte = denali_write_byte; |
| 1270 | chip->read_word = denali_read_word; |
| 1271 | chip->cmd_ctrl = denali_cmd_ctrl; |
| 1272 | chip->dev_ready = denali_dev_ready; |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1273 | chip->waitfunc = denali_waitfunc; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1274 | |
Masahiro Yamada | 29c4dd9 | 2017-09-22 12:46:48 +0900 | [diff] [blame] | 1275 | if (features & FEATURES__INDEX_ADDR) { |
| 1276 | denali->host_read = denali_indexed_read; |
| 1277 | denali->host_write = denali_indexed_write; |
| 1278 | } else { |
| 1279 | denali->host_read = denali_direct_read; |
| 1280 | denali->host_write = denali_direct_write; |
| 1281 | } |
| 1282 | |
Masahiro Yamada | 1bb8866 | 2017-06-13 22:45:37 +0900 | [diff] [blame] | 1283 | /* clk rate info is needed for setup_data_interface */ |
| 1284 | if (denali->clk_x_rate) |
| 1285 | chip->setup_data_interface = denali_setup_data_interface; |
| 1286 | |
Masahiro Yamada | a227d4e | 2016-11-09 13:35:28 +0900 | [diff] [blame] | 1287 | ret = nand_scan_ident(mtd, denali->max_banks, NULL); |
| 1288 | if (ret) |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1289 | goto disable_irq; |
Chuanxiao | 5bac3ac | 2010-08-05 23:06:04 +0800 | [diff] [blame] | 1290 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1291 | if (ioread32(denali->reg + FEATURES) & FEATURES__DMA) |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 1292 | denali->dma_avail = 1; |
| 1293 | |
| 1294 | if (denali->dma_avail) { |
| 1295 | int dma_bit = denali->caps & DENALI_CAP_DMA_64BIT ? 64 : 32; |
| 1296 | |
| 1297 | ret = dma_set_mask(denali->dev, DMA_BIT_MASK(dma_bit)); |
| 1298 | if (ret) { |
| 1299 | dev_info(denali->dev, |
| 1300 | "Failed to set DMA mask. Disabling DMA.\n"); |
| 1301 | denali->dma_avail = 0; |
| 1302 | } |
Huang Shijie | e07caa3 | 2013-12-21 00:02:28 +0800 | [diff] [blame] | 1303 | } |
| 1304 | |
Masahiro Yamada | 26d266e | 2017-06-13 22:45:45 +0900 | [diff] [blame] | 1305 | if (denali->dma_avail) { |
Masahiro Yamada | 997cde2 | 2017-06-13 22:45:47 +0900 | [diff] [blame] | 1306 | chip->options |= NAND_USE_BOUNCE_BUFFER; |
| 1307 | chip->buf_align = 16; |
Masahiro Yamada | 89dcb27 | 2017-09-22 12:46:49 +0900 | [diff] [blame^] | 1308 | if (denali->caps & DENALI_CAP_DMA_64BIT) |
| 1309 | denali->setup_dma = denali_setup_dma64; |
| 1310 | else |
| 1311 | denali->setup_dma = denali_setup_dma32; |
Chuanxiao.Dong | 66406524 | 2010-08-06 18:48:21 +0800 | [diff] [blame] | 1312 | } |
| 1313 | |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1314 | chip->bbt_options |= NAND_BBT_USE_FLASH; |
Masahiro Yamada | 777f2d4 | 2017-06-13 22:45:49 +0900 | [diff] [blame] | 1315 | chip->bbt_options |= NAND_BBT_NO_OOB; |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1316 | chip->ecc.mode = NAND_ECC_HW_SYNDROME; |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1317 | chip->options |= NAND_NO_SUBPAGE_WRITE; |
Graham Moore | d99d728 | 2015-01-14 09:38:50 -0600 | [diff] [blame] | 1318 | |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1319 | ret = denali_ecc_setup(mtd, chip, denali); |
| 1320 | if (ret) { |
| 1321 | dev_err(denali->dev, "Failed to setup ECC settings.\n"); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1322 | goto disable_irq; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1323 | } |
| 1324 | |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1325 | dev_dbg(denali->dev, |
| 1326 | "chosen ECC settings: step=%d, strength=%d, bytes=%d\n", |
| 1327 | chip->ecc.size, chip->ecc.strength, chip->ecc.bytes); |
| 1328 | |
Masahiro Yamada | e0d53b3 | 2017-09-22 12:46:43 +0900 | [diff] [blame] | 1329 | iowrite32(FIELD_PREP(ECC_CORRECTION__ERASE_THRESHOLD, 1) | |
| 1330 | FIELD_PREP(ECC_CORRECTION__VALUE, chip->ecc.strength), |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1331 | denali->reg + ECC_CORRECTION); |
Masahiro Yamada | 0615e7a | 2017-06-07 20:52:13 +0900 | [diff] [blame] | 1332 | iowrite32(mtd->erasesize / mtd->writesize, |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1333 | denali->reg + PAGES_PER_BLOCK); |
Masahiro Yamada | 0615e7a | 2017-06-07 20:52:13 +0900 | [diff] [blame] | 1334 | iowrite32(chip->options & NAND_BUSWIDTH_16 ? 1 : 0, |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1335 | denali->reg + DEVICE_WIDTH); |
Masahiro Yamada | a3750a6 | 2017-09-13 11:05:51 +0900 | [diff] [blame] | 1336 | iowrite32(chip->options & NAND_ROW_ADDR_3 ? 0 : TWO_ROW_ADDR_CYCLES__FLAG, |
| 1337 | denali->reg + TWO_ROW_ADDR_CYCLES); |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1338 | iowrite32(mtd->writesize, denali->reg + DEVICE_MAIN_AREA_SIZE); |
| 1339 | iowrite32(mtd->oobsize, denali->reg + DEVICE_SPARE_AREA_SIZE); |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1340 | |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1341 | iowrite32(chip->ecc.size, denali->reg + CFG_DATA_BLOCK_SIZE); |
| 1342 | iowrite32(chip->ecc.size, denali->reg + CFG_LAST_DATA_BLOCK_SIZE); |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1343 | /* chip->ecc.steps is set by nand_scan_tail(); not available here */ |
| 1344 | iowrite32(mtd->writesize / chip->ecc.size, |
Masahiro Yamada | 0d3a966 | 2017-06-16 14:36:39 +0900 | [diff] [blame] | 1345 | denali->reg + CFG_NUM_DATA_BLOCKS); |
Masahiro Yamada | 7de117f | 2017-06-07 20:52:12 +0900 | [diff] [blame] | 1346 | |
Boris Brezillon | 14fad62 | 2016-02-03 20:00:11 +0100 | [diff] [blame] | 1347 | mtd_set_ooblayout(mtd, &denali_ooblayout_ops); |
Chuanxiao Dong | db9a3210 | 2010-08-06 18:02:03 +0800 | [diff] [blame] | 1348 | |
Masahiro Yamada | fa6134e | 2017-06-13 22:45:39 +0900 | [diff] [blame] | 1349 | if (chip->options & NAND_BUSWIDTH_16) { |
| 1350 | chip->read_buf = denali_read_buf16; |
| 1351 | chip->write_buf = denali_write_buf16; |
| 1352 | } else { |
| 1353 | chip->read_buf = denali_read_buf; |
| 1354 | chip->write_buf = denali_write_buf; |
| 1355 | } |
Masahiro Yamada | b21ff82 | 2017-06-13 22:45:35 +0900 | [diff] [blame] | 1356 | chip->ecc.options |= NAND_ECC_CUSTOM_PAGE_ACCESS; |
Masahiro Yamada | 1394a72 | 2017-03-23 05:07:17 +0900 | [diff] [blame] | 1357 | chip->ecc.read_page = denali_read_page; |
| 1358 | chip->ecc.read_page_raw = denali_read_page_raw; |
| 1359 | chip->ecc.write_page = denali_write_page; |
| 1360 | chip->ecc.write_page_raw = denali_write_page_raw; |
| 1361 | chip->ecc.read_oob = denali_read_oob; |
| 1362 | chip->ecc.write_oob = denali_write_oob; |
| 1363 | chip->erase = denali_erase; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1364 | |
Masahiro Yamada | e93c164 | 2017-03-23 05:07:21 +0900 | [diff] [blame] | 1365 | ret = denali_multidev_fixup(denali); |
| 1366 | if (ret) |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1367 | goto disable_irq; |
Masahiro Yamada | 6da27b4 | 2017-03-23 05:07:20 +0900 | [diff] [blame] | 1368 | |
Masahiro Yamada | 7d370b2 | 2017-06-13 22:45:48 +0900 | [diff] [blame] | 1369 | /* |
| 1370 | * This buffer is DMA-mapped by denali_{read,write}_page_raw. Do not |
| 1371 | * use devm_kmalloc() because the memory allocated by devm_ does not |
| 1372 | * guarantee DMA-safe alignment. |
| 1373 | */ |
| 1374 | denali->buf = kmalloc(mtd->writesize + mtd->oobsize, GFP_KERNEL); |
| 1375 | if (!denali->buf) { |
| 1376 | ret = -ENOMEM; |
| 1377 | goto disable_irq; |
| 1378 | } |
| 1379 | |
Masahiro Yamada | a227d4e | 2016-11-09 13:35:28 +0900 | [diff] [blame] | 1380 | ret = nand_scan_tail(mtd); |
| 1381 | if (ret) |
Masahiro Yamada | 7d370b2 | 2017-06-13 22:45:48 +0900 | [diff] [blame] | 1382 | goto free_buf; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1383 | |
Boris BREZILLON | 442f201b | 2015-12-11 15:06:00 +0100 | [diff] [blame] | 1384 | ret = mtd_device_register(mtd, NULL, 0); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1385 | if (ret) { |
Masahiro Yamada | 789ccf1 | 2016-11-09 13:35:24 +0900 | [diff] [blame] | 1386 | dev_err(denali->dev, "Failed to register MTD: %d\n", ret); |
Masahiro Yamada | 7d370b2 | 2017-06-13 22:45:48 +0900 | [diff] [blame] | 1387 | goto free_buf; |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1388 | } |
| 1389 | return 0; |
| 1390 | |
Masahiro Yamada | 7d370b2 | 2017-06-13 22:45:48 +0900 | [diff] [blame] | 1391 | free_buf: |
| 1392 | kfree(denali->buf); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1393 | disable_irq: |
| 1394 | denali_disable_irq(denali); |
Dinh Nguyen | 2a0a288 | 2012-09-27 10:58:05 -0600 | [diff] [blame] | 1395 | |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1396 | return ret; |
| 1397 | } |
Dinh Nguyen | 2a0a288 | 2012-09-27 10:58:05 -0600 | [diff] [blame] | 1398 | EXPORT_SYMBOL(denali_init); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1399 | |
Dinh Nguyen | 2a0a288 | 2012-09-27 10:58:05 -0600 | [diff] [blame] | 1400 | void denali_remove(struct denali_nand_info *denali) |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1401 | { |
Boris BREZILLON | 442f201b | 2015-12-11 15:06:00 +0100 | [diff] [blame] | 1402 | struct mtd_info *mtd = nand_to_mtd(&denali->nand); |
Boris BREZILLON | 320092a | 2015-12-11 15:02:34 +0100 | [diff] [blame] | 1403 | |
Boris BREZILLON | 442f201b | 2015-12-11 15:06:00 +0100 | [diff] [blame] | 1404 | nand_release(mtd); |
Masahiro Yamada | 7d370b2 | 2017-06-13 22:45:48 +0900 | [diff] [blame] | 1405 | kfree(denali->buf); |
Masahiro Yamada | c19e31d | 2017-06-13 22:45:38 +0900 | [diff] [blame] | 1406 | denali_disable_irq(denali); |
Jason Roberts | ce08259 | 2010-05-13 15:57:33 +0100 | [diff] [blame] | 1407 | } |
Dinh Nguyen | 2a0a288 | 2012-09-27 10:58:05 -0600 | [diff] [blame] | 1408 | EXPORT_SYMBOL(denali_remove); |