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