1 1.29 thorpej /* $NetBSD: nand.c,v 1.29 2021/08/07 16:19:13 thorpej Exp $ */ 2 1.1 ahoka 3 1.1 ahoka /*- 4 1.1 ahoka * Copyright (c) 2010 Department of Software Engineering, 5 1.1 ahoka * University of Szeged, Hungary 6 1.1 ahoka * Copyright (c) 2010 Adam Hoka <ahoka (at) NetBSD.org> 7 1.1 ahoka * All rights reserved. 8 1.1 ahoka * 9 1.1 ahoka * This code is derived from software contributed to The NetBSD Foundation 10 1.1 ahoka * by the Department of Software Engineering, University of Szeged, Hungary 11 1.1 ahoka * 12 1.1 ahoka * Redistribution and use in source and binary forms, with or without 13 1.1 ahoka * modification, are permitted provided that the following conditions 14 1.1 ahoka * are met: 15 1.1 ahoka * 1. Redistributions of source code must retain the above copyright 16 1.1 ahoka * notice, this list of conditions and the following disclaimer. 17 1.1 ahoka * 2. Redistributions in binary form must reproduce the above copyright 18 1.1 ahoka * notice, this list of conditions and the following disclaimer in the 19 1.1 ahoka * documentation and/or other materials provided with the distribution. 20 1.1 ahoka * 21 1.1 ahoka * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 22 1.1 ahoka * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 23 1.1 ahoka * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 24 1.1 ahoka * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 25 1.1 ahoka * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26 1.1 ahoka * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 27 1.1 ahoka * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28 1.1 ahoka * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29 1.1 ahoka * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30 1.1 ahoka * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 1.1 ahoka * SUCH DAMAGE. 32 1.1 ahoka */ 33 1.1 ahoka 34 1.1 ahoka /* Common driver for NAND chips implementing the ONFI 2.2 specification */ 35 1.1 ahoka 36 1.1 ahoka #include <sys/cdefs.h> 37 1.29 thorpej __KERNEL_RCSID(0, "$NetBSD: nand.c,v 1.29 2021/08/07 16:19:13 thorpej Exp $"); 38 1.1 ahoka 39 1.1 ahoka #include "locators.h" 40 1.1 ahoka 41 1.1 ahoka #include <sys/param.h> 42 1.1 ahoka #include <sys/types.h> 43 1.1 ahoka #include <sys/device.h> 44 1.1 ahoka #include <sys/kmem.h> 45 1.9 ahoka #include <sys/atomic.h> 46 1.1 ahoka 47 1.1 ahoka #include <dev/flash/flash.h> 48 1.13 ahoka #include <dev/flash/flash_io.h> 49 1.1 ahoka #include <dev/nand/nand.h> 50 1.1 ahoka #include <dev/nand/onfi.h> 51 1.1 ahoka #include <dev/nand/hamming.h> 52 1.1 ahoka #include <dev/nand/nand_bbt.h> 53 1.1 ahoka #include <dev/nand/nand_crc.h> 54 1.1 ahoka 55 1.1 ahoka #include "opt_nand.h" 56 1.1 ahoka 57 1.2 ahoka int nand_match(device_t, cfdata_t, void *); 58 1.2 ahoka void nand_attach(device_t, device_t, void *); 59 1.2 ahoka int nand_detach(device_t, int); 60 1.2 ahoka bool nand_shutdown(device_t, int); 61 1.2 ahoka 62 1.2 ahoka int nand_print(void *, const char *); 63 1.2 ahoka 64 1.2 ahoka static int nand_search(device_t, cfdata_t, const int *, void *); 65 1.2 ahoka static void nand_address_row(device_t, size_t); 66 1.24 kiyohara static inline uint8_t nand_get_status(device_t); 67 1.2 ahoka static void nand_address_column(device_t, size_t, size_t); 68 1.6 ahoka static int nand_fill_chip_structure(device_t, struct nand_chip *); 69 1.2 ahoka static int nand_scan_media(device_t, struct nand_chip *); 70 1.2 ahoka static bool nand_check_wp(device_t); 71 1.1 ahoka 72 1.10 ahoka CFATTACH_DECL_NEW(nand, sizeof(struct nand_softc), 73 1.10 ahoka nand_match, nand_attach, nand_detach, NULL); 74 1.1 ahoka 75 1.1 ahoka #ifdef NAND_DEBUG 76 1.1 ahoka int nanddebug = NAND_DEBUG; 77 1.1 ahoka #endif 78 1.1 ahoka 79 1.13 ahoka struct flash_interface nand_flash_if = { 80 1.13 ahoka .type = FLASH_TYPE_NAND, 81 1.13 ahoka 82 1.13 ahoka .read = nand_flash_read, 83 1.13 ahoka .write = nand_flash_write, 84 1.13 ahoka .erase = nand_flash_erase, 85 1.13 ahoka .block_isbad = nand_flash_isbad, 86 1.13 ahoka .block_markbad = nand_flash_markbad, 87 1.13 ahoka 88 1.14 ahoka .submit = nand_flash_submit 89 1.13 ahoka }; 90 1.1 ahoka 91 1.1 ahoka const struct nand_manufacturer nand_mfrs[] = { 92 1.1 ahoka { NAND_MFR_AMD, "AMD" }, 93 1.1 ahoka { NAND_MFR_FUJITSU, "Fujitsu" }, 94 1.1 ahoka { NAND_MFR_RENESAS, "Renesas" }, 95 1.1 ahoka { NAND_MFR_STMICRO, "ST Micro" }, 96 1.1 ahoka { NAND_MFR_MICRON, "Micron" }, 97 1.1 ahoka { NAND_MFR_NATIONAL, "National" }, 98 1.1 ahoka { NAND_MFR_TOSHIBA, "Toshiba" }, 99 1.1 ahoka { NAND_MFR_HYNIX, "Hynix" }, 100 1.1 ahoka { NAND_MFR_SAMSUNG, "Samsung" }, 101 1.1 ahoka { NAND_MFR_UNKNOWN, "Unknown" } 102 1.1 ahoka }; 103 1.1 ahoka 104 1.6 ahoka static const char * 105 1.6 ahoka nand_midtoname(int id) 106 1.6 ahoka { 107 1.6 ahoka int i; 108 1.6 ahoka 109 1.6 ahoka for (i = 0; nand_mfrs[i].id != 0; i++) { 110 1.6 ahoka if (nand_mfrs[i].id == id) 111 1.6 ahoka return nand_mfrs[i].name; 112 1.6 ahoka } 113 1.6 ahoka 114 1.6 ahoka KASSERT(nand_mfrs[i].id == 0); 115 1.6 ahoka 116 1.6 ahoka return nand_mfrs[i].name; 117 1.6 ahoka } 118 1.6 ahoka 119 1.1 ahoka /* ARGSUSED */ 120 1.1 ahoka int 121 1.1 ahoka nand_match(device_t parent, cfdata_t match, void *aux) 122 1.1 ahoka { 123 1.1 ahoka /* pseudo device, always attaches */ 124 1.1 ahoka return 1; 125 1.1 ahoka } 126 1.1 ahoka 127 1.1 ahoka void 128 1.1 ahoka nand_attach(device_t parent, device_t self, void *aux) 129 1.1 ahoka { 130 1.1 ahoka struct nand_softc *sc = device_private(self); 131 1.1 ahoka struct nand_attach_args *naa = aux; 132 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 133 1.1 ahoka 134 1.1 ahoka sc->sc_dev = self; 135 1.6 ahoka sc->controller_dev = parent; 136 1.1 ahoka sc->nand_if = naa->naa_nand_if; 137 1.1 ahoka 138 1.1 ahoka aprint_naive("\n"); 139 1.1 ahoka 140 1.1 ahoka if (nand_check_wp(self)) { 141 1.1 ahoka aprint_error("NAND chip is write protected!\n"); 142 1.1 ahoka return; 143 1.1 ahoka } 144 1.12 ahoka 145 1.3 ahoka if (nand_scan_media(self, chip)) { 146 1.1 ahoka return; 147 1.3 ahoka } 148 1.1 ahoka 149 1.13 ahoka nand_flash_if.erasesize = chip->nc_block_size; 150 1.13 ahoka nand_flash_if.page_size = chip->nc_page_size; 151 1.13 ahoka nand_flash_if.writesize = chip->nc_page_size; 152 1.13 ahoka 153 1.1 ahoka /* allocate cache */ 154 1.1 ahoka chip->nc_oob_cache = kmem_alloc(chip->nc_spare_size, KM_SLEEP); 155 1.1 ahoka chip->nc_page_cache = kmem_alloc(chip->nc_page_size, KM_SLEEP); 156 1.1 ahoka 157 1.1 ahoka mutex_init(&sc->sc_device_lock, MUTEX_DEFAULT, IPL_NONE); 158 1.1 ahoka 159 1.15 cliff if (flash_sync_thread_init(&sc->sc_flash_io, self, &nand_flash_if)) { 160 1.1 ahoka goto error; 161 1.1 ahoka } 162 1.1 ahoka 163 1.1 ahoka if (!pmf_device_register1(sc->sc_dev, NULL, NULL, nand_shutdown)) 164 1.1 ahoka aprint_error_dev(sc->sc_dev, 165 1.1 ahoka "couldn't establish power handler\n"); 166 1.1 ahoka 167 1.1 ahoka #ifdef NAND_BBT 168 1.1 ahoka nand_bbt_init(self); 169 1.1 ahoka nand_bbt_scan(self); 170 1.1 ahoka #endif 171 1.1 ahoka 172 1.1 ahoka /* 173 1.1 ahoka * Attach all our devices 174 1.1 ahoka */ 175 1.28 thorpej config_search(self, NULL, 176 1.29 thorpej CFARGS(.search = nand_search)); 177 1.1 ahoka 178 1.1 ahoka return; 179 1.1 ahoka error: 180 1.1 ahoka kmem_free(chip->nc_oob_cache, chip->nc_spare_size); 181 1.1 ahoka kmem_free(chip->nc_page_cache, chip->nc_page_size); 182 1.1 ahoka mutex_destroy(&sc->sc_device_lock); 183 1.1 ahoka } 184 1.1 ahoka 185 1.1 ahoka static int 186 1.1 ahoka nand_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux) 187 1.1 ahoka { 188 1.1 ahoka struct nand_softc *sc = device_private(parent); 189 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 190 1.1 ahoka struct flash_attach_args faa; 191 1.1 ahoka 192 1.27 jmcneill if (cf->cf_loc[FLASHBUSCF_DYNAMIC] != 0) 193 1.27 jmcneill return 0; 194 1.27 jmcneill 195 1.13 ahoka faa.flash_if = &nand_flash_if; 196 1.1 ahoka 197 1.27 jmcneill faa.partinfo.part_name = NULL; 198 1.13 ahoka faa.partinfo.part_offset = cf->cf_loc[FLASHBUSCF_OFFSET]; 199 1.1 ahoka 200 1.1 ahoka if (cf->cf_loc[FLASHBUSCF_SIZE] == 0) { 201 1.13 ahoka faa.partinfo.part_size = chip->nc_size - 202 1.13 ahoka faa.partinfo.part_offset; 203 1.1 ahoka } else { 204 1.13 ahoka faa.partinfo.part_size = cf->cf_loc[FLASHBUSCF_SIZE]; 205 1.1 ahoka } 206 1.1 ahoka 207 1.1 ahoka if (cf->cf_loc[FLASHBUSCF_READONLY]) 208 1.13 ahoka faa.partinfo.part_flags = FLASH_PART_READONLY; 209 1.1 ahoka else 210 1.13 ahoka faa.partinfo.part_flags = 0; 211 1.1 ahoka 212 1.28 thorpej if (config_probe(parent, cf, &faa)) { 213 1.28 thorpej if (config_attach(parent, cf, &faa, nand_print, 214 1.29 thorpej CFARGS_NONE) != NULL) { 215 1.9 ahoka return 0; 216 1.9 ahoka } else { 217 1.9 ahoka return 1; 218 1.9 ahoka } 219 1.1 ahoka } 220 1.1 ahoka 221 1.1 ahoka return 1; 222 1.1 ahoka } 223 1.1 ahoka 224 1.27 jmcneill void 225 1.27 jmcneill nand_attach_mtdparts(device_t parent, const char *mtd_id, const char *cmdline) 226 1.27 jmcneill { 227 1.27 jmcneill struct nand_softc *sc = device_private(parent); 228 1.27 jmcneill struct nand_chip *chip = &sc->sc_chip; 229 1.27 jmcneill 230 1.27 jmcneill flash_attach_mtdparts(&nand_flash_if, parent, chip->nc_size, 231 1.27 jmcneill mtd_id, cmdline); 232 1.27 jmcneill } 233 1.27 jmcneill 234 1.1 ahoka int 235 1.1 ahoka nand_detach(device_t self, int flags) 236 1.1 ahoka { 237 1.1 ahoka struct nand_softc *sc = device_private(self); 238 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 239 1.10 ahoka int error = 0; 240 1.1 ahoka 241 1.10 ahoka error = config_detach_children(self, flags); 242 1.10 ahoka if (error) { 243 1.10 ahoka return error; 244 1.9 ahoka } 245 1.9 ahoka 246 1.14 ahoka flash_sync_thread_destroy(&sc->sc_flash_io); 247 1.1 ahoka #ifdef NAND_BBT 248 1.1 ahoka nand_bbt_detach(self); 249 1.1 ahoka #endif 250 1.1 ahoka /* free oob cache */ 251 1.1 ahoka kmem_free(chip->nc_oob_cache, chip->nc_spare_size); 252 1.1 ahoka kmem_free(chip->nc_page_cache, chip->nc_page_size); 253 1.1 ahoka kmem_free(chip->nc_ecc_cache, chip->nc_ecc->necc_size); 254 1.1 ahoka 255 1.1 ahoka mutex_destroy(&sc->sc_device_lock); 256 1.1 ahoka 257 1.1 ahoka pmf_device_deregister(sc->sc_dev); 258 1.1 ahoka 259 1.10 ahoka return error; 260 1.9 ahoka } 261 1.9 ahoka 262 1.1 ahoka int 263 1.1 ahoka nand_print(void *aux, const char *pnp) 264 1.1 ahoka { 265 1.1 ahoka if (pnp != NULL) 266 1.1 ahoka aprint_normal("nand at %s\n", pnp); 267 1.1 ahoka 268 1.1 ahoka return UNCONF; 269 1.1 ahoka } 270 1.1 ahoka 271 1.6 ahoka /* ask for a nand driver to attach to the controller */ 272 1.1 ahoka device_t 273 1.1 ahoka nand_attach_mi(struct nand_interface *nand_if, device_t parent) 274 1.1 ahoka { 275 1.1 ahoka struct nand_attach_args arg; 276 1.1 ahoka 277 1.1 ahoka KASSERT(nand_if != NULL); 278 1.1 ahoka 279 1.6 ahoka /* fill the defaults if we have null pointers */ 280 1.6 ahoka if (nand_if->program_page == NULL) { 281 1.6 ahoka nand_if->program_page = &nand_default_program_page; 282 1.6 ahoka } 283 1.6 ahoka 284 1.6 ahoka if (nand_if->read_page == NULL) { 285 1.6 ahoka nand_if->read_page = &nand_default_read_page; 286 1.6 ahoka } 287 1.6 ahoka 288 1.1 ahoka arg.naa_nand_if = nand_if; 289 1.28 thorpej return config_found(parent, &arg, nand_print, 290 1.29 thorpej CFARGS(.iattr = "nandbus")); 291 1.1 ahoka } 292 1.1 ahoka 293 1.6 ahoka /* default everything to reasonable values, to ease future api changes */ 294 1.6 ahoka void 295 1.6 ahoka nand_init_interface(struct nand_interface *interface) 296 1.1 ahoka { 297 1.6 ahoka interface->select = &nand_default_select; 298 1.6 ahoka interface->command = NULL; 299 1.6 ahoka interface->address = NULL; 300 1.12 ahoka interface->read_buf_1 = NULL; 301 1.12 ahoka interface->read_buf_2 = NULL; 302 1.12 ahoka interface->read_1 = NULL; 303 1.12 ahoka interface->read_2 = NULL; 304 1.12 ahoka interface->write_buf_1 = NULL; 305 1.12 ahoka interface->write_buf_2 = NULL; 306 1.12 ahoka interface->write_1 = NULL; 307 1.12 ahoka interface->write_2 = NULL; 308 1.6 ahoka interface->busy = NULL; 309 1.6 ahoka 310 1.6 ahoka /*- 311 1.6 ahoka * most drivers dont want to change this, but some implement 312 1.6 ahoka * read/program in one step 313 1.6 ahoka */ 314 1.6 ahoka interface->program_page = &nand_default_program_page; 315 1.6 ahoka interface->read_page = &nand_default_read_page; 316 1.1 ahoka 317 1.6 ahoka /* default to soft ecc, that should work everywhere */ 318 1.6 ahoka interface->ecc_compute = &nand_default_ecc_compute; 319 1.6 ahoka interface->ecc_correct = &nand_default_ecc_correct; 320 1.6 ahoka interface->ecc_prepare = NULL; 321 1.6 ahoka interface->ecc.necc_code_size = 3; 322 1.6 ahoka interface->ecc.necc_block_size = 256; 323 1.6 ahoka interface->ecc.necc_type = NAND_ECC_TYPE_SW; 324 1.1 ahoka } 325 1.1 ahoka 326 1.1 ahoka #if 0 327 1.1 ahoka /* handle quirks here */ 328 1.1 ahoka static void 329 1.1 ahoka nand_quirks(device_t self, struct nand_chip *chip) 330 1.1 ahoka { 331 1.1 ahoka /* this is an example only! */ 332 1.1 ahoka switch (chip->nc_manf_id) { 333 1.1 ahoka case NAND_MFR_SAMSUNG: 334 1.1 ahoka if (chip->nc_dev_id == 0x00) { 335 1.1 ahoka /* do something only samsung chips need */ 336 1.1 ahoka /* or */ 337 1.1 ahoka /* chip->nc_quirks |= NC_QUIRK_NO_READ_START */ 338 1.1 ahoka } 339 1.1 ahoka } 340 1.1 ahoka 341 1.1 ahoka return; 342 1.1 ahoka } 343 1.1 ahoka #endif 344 1.1 ahoka 345 1.3 ahoka static int 346 1.6 ahoka nand_fill_chip_structure_legacy(device_t self, struct nand_chip *chip) 347 1.3 ahoka { 348 1.3 ahoka switch (chip->nc_manf_id) { 349 1.3 ahoka case NAND_MFR_MICRON: 350 1.3 ahoka return nand_read_parameters_micron(self, chip); 351 1.18 riz case NAND_MFR_SAMSUNG: 352 1.18 riz return nand_read_parameters_samsung(self, chip); 353 1.26 jmcneill case NAND_MFR_TOSHIBA: 354 1.26 jmcneill return nand_read_parameters_toshiba(self, chip); 355 1.3 ahoka default: 356 1.3 ahoka return 1; 357 1.3 ahoka } 358 1.11 rmind 359 1.3 ahoka return 0; 360 1.3 ahoka } 361 1.3 ahoka 362 1.1 ahoka /** 363 1.1 ahoka * scan media to determine the chip's properties 364 1.1 ahoka * this function resets the device 365 1.1 ahoka */ 366 1.1 ahoka static int 367 1.1 ahoka nand_scan_media(device_t self, struct nand_chip *chip) 368 1.1 ahoka { 369 1.1 ahoka struct nand_softc *sc = device_private(self); 370 1.1 ahoka struct nand_ecc *ecc; 371 1.1 ahoka uint8_t onfi_signature[4]; 372 1.1 ahoka 373 1.1 ahoka nand_select(self, true); 374 1.1 ahoka nand_command(self, ONFI_RESET); 375 1.24 kiyohara KASSERT(nand_get_status(self) & ONFI_STATUS_RDY); 376 1.1 ahoka nand_select(self, false); 377 1.1 ahoka 378 1.3 ahoka /* check if the device implements the ONFI standard */ 379 1.1 ahoka nand_select(self, true); 380 1.1 ahoka nand_command(self, ONFI_READ_ID); 381 1.1 ahoka nand_address(self, 0x20); 382 1.12 ahoka nand_read_1(self, &onfi_signature[0]); 383 1.12 ahoka nand_read_1(self, &onfi_signature[1]); 384 1.12 ahoka nand_read_1(self, &onfi_signature[2]); 385 1.12 ahoka nand_read_1(self, &onfi_signature[3]); 386 1.1 ahoka nand_select(self, false); 387 1.1 ahoka 388 1.26 jmcneill #ifdef NAND_DEBUG 389 1.26 jmcneill device_printf(self, "signature: %02x %02x %02x %02x\n", 390 1.26 jmcneill onfi_signature[0], onfi_signature[1], 391 1.26 jmcneill onfi_signature[2], onfi_signature[3]); 392 1.26 jmcneill #endif 393 1.26 jmcneill 394 1.1 ahoka if (onfi_signature[0] != 'O' || onfi_signature[1] != 'N' || 395 1.1 ahoka onfi_signature[2] != 'F' || onfi_signature[3] != 'I') { 396 1.3 ahoka chip->nc_isonfi = false; 397 1.11 rmind 398 1.3 ahoka aprint_normal(": Legacy NAND Flash\n"); 399 1.11 rmind 400 1.6 ahoka nand_read_id(self, &chip->nc_manf_id, &chip->nc_dev_id); 401 1.1 ahoka 402 1.6 ahoka if (nand_fill_chip_structure_legacy(self, chip)) { 403 1.3 ahoka aprint_error_dev(self, 404 1.3 ahoka "can't read device parameters for legacy chip\n"); 405 1.3 ahoka return 1; 406 1.3 ahoka } 407 1.3 ahoka } else { 408 1.3 ahoka chip->nc_isonfi = true; 409 1.1 ahoka 410 1.3 ahoka aprint_normal(": ONFI NAND Flash\n"); 411 1.1 ahoka 412 1.6 ahoka nand_read_id(self, &chip->nc_manf_id, &chip->nc_dev_id); 413 1.11 rmind 414 1.6 ahoka if (nand_fill_chip_structure(self, chip)) { 415 1.6 ahoka aprint_error_dev(self, 416 1.6 ahoka "can't read device parameters\n"); 417 1.6 ahoka return 1; 418 1.6 ahoka } 419 1.3 ahoka } 420 1.1 ahoka 421 1.3 ahoka aprint_normal_dev(self, 422 1.1 ahoka "manufacturer id: 0x%.2x (%s), device id: 0x%.2x\n", 423 1.1 ahoka chip->nc_manf_id, 424 1.1 ahoka nand_midtoname(chip->nc_manf_id), 425 1.1 ahoka chip->nc_dev_id); 426 1.1 ahoka 427 1.3 ahoka aprint_normal_dev(self, 428 1.19 ahoka "page size: %" PRIu32 " bytes, spare size: %" PRIu32 " bytes, " 429 1.19 ahoka "block size: %" PRIu32 " bytes\n", 430 1.3 ahoka chip->nc_page_size, chip->nc_spare_size, chip->nc_block_size); 431 1.3 ahoka 432 1.3 ahoka aprint_normal_dev(self, 433 1.5 ahoka "LUN size: %" PRIu32 " blocks, LUNs: %" PRIu8 434 1.19 ahoka ", total storage size: %" PRIu64 " MB\n", 435 1.3 ahoka chip->nc_lun_blocks, chip->nc_num_luns, 436 1.3 ahoka chip->nc_size / 1024 / 1024); 437 1.1 ahoka 438 1.5 ahoka aprint_normal_dev(self, "column cycles: %" PRIu8 ", row cycles: %" 439 1.21 ahoka PRIu8 ", width: %s\n", 440 1.21 ahoka chip->nc_addr_cycles_column, chip->nc_addr_cycles_row, 441 1.21 ahoka (chip->nc_flags & NC_BUSWIDTH_16) ? "x16" : "x8"); 442 1.12 ahoka 443 1.1 ahoka ecc = chip->nc_ecc = &sc->nand_if->ecc; 444 1.1 ahoka 445 1.1 ahoka /* 446 1.1 ahoka * calculate the place of ecc data in oob 447 1.1 ahoka * we try to be compatible with Linux here 448 1.1 ahoka */ 449 1.1 ahoka switch (chip->nc_spare_size) { 450 1.1 ahoka case 8: 451 1.1 ahoka ecc->necc_offset = 0; 452 1.1 ahoka break; 453 1.1 ahoka case 16: 454 1.1 ahoka ecc->necc_offset = 0; 455 1.1 ahoka break; 456 1.17 matt case 32: 457 1.17 matt ecc->necc_offset = 0; 458 1.17 matt break; 459 1.1 ahoka case 64: 460 1.1 ahoka ecc->necc_offset = 40; 461 1.1 ahoka break; 462 1.1 ahoka case 128: 463 1.1 ahoka ecc->necc_offset = 80; 464 1.1 ahoka break; 465 1.1 ahoka default: 466 1.19 ahoka panic("OOB size %" PRIu32 " is unexpected", chip->nc_spare_size); 467 1.1 ahoka } 468 1.1 ahoka 469 1.1 ahoka ecc->necc_steps = chip->nc_page_size / ecc->necc_block_size; 470 1.1 ahoka ecc->necc_size = ecc->necc_steps * ecc->necc_code_size; 471 1.1 ahoka 472 1.1 ahoka /* check if we fit in oob */ 473 1.1 ahoka if (ecc->necc_offset + ecc->necc_size > chip->nc_spare_size) { 474 1.1 ahoka panic("NAND ECC bits dont fit in OOB"); 475 1.1 ahoka } 476 1.1 ahoka 477 1.1 ahoka /* TODO: mark free oob area available for file systems */ 478 1.1 ahoka 479 1.1 ahoka chip->nc_ecc_cache = kmem_zalloc(ecc->necc_size, KM_SLEEP); 480 1.1 ahoka 481 1.1 ahoka /* 482 1.1 ahoka * calculate badblock marker offset in oob 483 1.1 ahoka * we try to be compatible with linux here 484 1.1 ahoka */ 485 1.1 ahoka if (chip->nc_page_size > 512) 486 1.1 ahoka chip->nc_badmarker_offs = 0; 487 1.1 ahoka else 488 1.1 ahoka chip->nc_badmarker_offs = 5; 489 1.1 ahoka 490 1.1 ahoka /* Calculate page shift and mask */ 491 1.1 ahoka chip->nc_page_shift = ffs(chip->nc_page_size) - 1; 492 1.1 ahoka chip->nc_page_mask = ~(chip->nc_page_size - 1); 493 1.1 ahoka /* same for block */ 494 1.1 ahoka chip->nc_block_shift = ffs(chip->nc_block_size) - 1; 495 1.1 ahoka chip->nc_block_mask = ~(chip->nc_block_size - 1); 496 1.1 ahoka 497 1.1 ahoka /* look for quirks here if needed in future */ 498 1.1 ahoka /* nand_quirks(self, chip); */ 499 1.1 ahoka 500 1.1 ahoka return 0; 501 1.1 ahoka } 502 1.1 ahoka 503 1.6 ahoka void 504 1.6 ahoka nand_read_id(device_t self, uint8_t *manf, uint8_t *dev) 505 1.1 ahoka { 506 1.1 ahoka nand_select(self, true); 507 1.1 ahoka nand_command(self, ONFI_READ_ID); 508 1.1 ahoka nand_address(self, 0x00); 509 1.11 rmind 510 1.12 ahoka nand_read_1(self, manf); 511 1.12 ahoka nand_read_1(self, dev); 512 1.11 rmind 513 1.1 ahoka nand_select(self, false); 514 1.1 ahoka } 515 1.1 ahoka 516 1.6 ahoka int 517 1.6 ahoka nand_read_parameter_page(device_t self, struct onfi_parameter_page *params) 518 1.1 ahoka { 519 1.1 ahoka uint8_t *bufp; 520 1.1 ahoka uint16_t crc; 521 1.6 ahoka int i;//, tries = 0; 522 1.1 ahoka 523 1.6 ahoka KASSERT(sizeof(*params) == 256); 524 1.1 ahoka 525 1.6 ahoka //read_params: 526 1.6 ahoka // tries++; 527 1.12 ahoka 528 1.1 ahoka nand_select(self, true); 529 1.1 ahoka nand_command(self, ONFI_READ_PARAMETER_PAGE); 530 1.1 ahoka nand_address(self, 0x00); 531 1.1 ahoka 532 1.1 ahoka nand_busy(self); 533 1.1 ahoka 534 1.6 ahoka /* TODO check the signature if it contains at least 2 letters */ 535 1.6 ahoka 536 1.6 ahoka bufp = (uint8_t *)params; 537 1.6 ahoka /* XXX why i am not using read_buf? */ 538 1.1 ahoka for (i = 0; i < 256; i++) { 539 1.12 ahoka nand_read_1(self, &bufp[i]); 540 1.1 ahoka } 541 1.1 ahoka nand_select(self, false); 542 1.12 ahoka 543 1.1 ahoka /* validate the parameter page with the crc */ 544 1.1 ahoka crc = nand_crc16(bufp, 254); 545 1.1 ahoka 546 1.6 ahoka if (crc != params->param_integrity_crc) { 547 1.1 ahoka aprint_error_dev(self, "parameter page crc check failed\n"); 548 1.1 ahoka /* TODO: we should read the next parameter page copy */ 549 1.6 ahoka return 1; 550 1.6 ahoka } 551 1.6 ahoka 552 1.6 ahoka return 0; 553 1.6 ahoka } 554 1.6 ahoka 555 1.6 ahoka static int 556 1.6 ahoka nand_fill_chip_structure(device_t self, struct nand_chip *chip) 557 1.6 ahoka { 558 1.6 ahoka struct onfi_parameter_page params; 559 1.6 ahoka uint8_t vendor[13], model[21]; 560 1.6 ahoka int i; 561 1.6 ahoka 562 1.6 ahoka if (nand_read_parameter_page(self, ¶ms)) { 563 1.6 ahoka return 1; 564 1.1 ahoka } 565 1.1 ahoka 566 1.1 ahoka /* strip manufacturer and model string */ 567 1.1 ahoka strlcpy(vendor, params.param_manufacturer, sizeof(vendor)); 568 1.1 ahoka for (i = 11; i > 0 && vendor[i] == ' '; i--) 569 1.1 ahoka vendor[i] = 0; 570 1.1 ahoka strlcpy(model, params.param_model, sizeof(model)); 571 1.1 ahoka for (i = 19; i > 0 && model[i] == ' '; i--) 572 1.1 ahoka model[i] = 0; 573 1.1 ahoka 574 1.1 ahoka aprint_normal_dev(self, "vendor: %s, model: %s\n", vendor, model); 575 1.1 ahoka 576 1.22 ahoka chip->nc_page_size = le32toh(params.param_pagesize); 577 1.22 ahoka chip->nc_block_size = 578 1.22 ahoka le32toh(params.param_blocksize) * chip->nc_page_size; 579 1.22 ahoka chip->nc_spare_size = le16toh(params.param_sparesize); 580 1.22 ahoka chip->nc_lun_blocks = le32toh(params.param_lunsize); 581 1.22 ahoka chip->nc_num_luns = params.param_numluns; 582 1.1 ahoka 583 1.22 ahoka chip->nc_size = 584 1.22 ahoka chip->nc_block_size * chip->nc_lun_blocks * chip->nc_num_luns; 585 1.1 ahoka 586 1.1 ahoka /* the lower 4 bits contain the row address cycles */ 587 1.1 ahoka chip->nc_addr_cycles_row = params.param_addr_cycles & 0x07; 588 1.1 ahoka /* the upper 4 bits contain the column address cycles */ 589 1.1 ahoka chip->nc_addr_cycles_column = (params.param_addr_cycles & ~0x07) >> 4; 590 1.1 ahoka 591 1.22 ahoka uint16_t features = le16toh(params.param_features); 592 1.22 ahoka if (features & ONFI_FEATURE_16BIT) { 593 1.1 ahoka chip->nc_flags |= NC_BUSWIDTH_16; 594 1.22 ahoka } 595 1.1 ahoka 596 1.22 ahoka if (features & ONFI_FEATURE_EXTENDED_PARAM) { 597 1.1 ahoka chip->nc_flags |= NC_EXTENDED_PARAM; 598 1.22 ahoka } 599 1.6 ahoka 600 1.6 ahoka return 0; 601 1.1 ahoka } 602 1.1 ahoka 603 1.1 ahoka /* ARGSUSED */ 604 1.1 ahoka bool 605 1.1 ahoka nand_shutdown(device_t self, int howto) 606 1.1 ahoka { 607 1.1 ahoka return true; 608 1.1 ahoka } 609 1.1 ahoka 610 1.1 ahoka static void 611 1.1 ahoka nand_address_column(device_t self, size_t row, size_t column) 612 1.1 ahoka { 613 1.1 ahoka struct nand_softc *sc = device_private(self); 614 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 615 1.1 ahoka uint8_t i; 616 1.1 ahoka 617 1.19 ahoka DPRINTF(("addressing row: 0x%jx column: %" PRIu32 "\n", 618 1.1 ahoka (uintmax_t )row, column)); 619 1.1 ahoka 620 1.1 ahoka /* XXX TODO */ 621 1.1 ahoka row >>= chip->nc_page_shift; 622 1.1 ahoka 623 1.1 ahoka /* Write the column (subpage) address */ 624 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) 625 1.1 ahoka column >>= 1; 626 1.1 ahoka for (i = 0; i < chip->nc_addr_cycles_column; i++, column >>= 8) 627 1.1 ahoka nand_address(self, column & 0xff); 628 1.1 ahoka 629 1.1 ahoka /* Write the row (page) address */ 630 1.1 ahoka for (i = 0; i < chip->nc_addr_cycles_row; i++, row >>= 8) 631 1.1 ahoka nand_address(self, row & 0xff); 632 1.1 ahoka } 633 1.1 ahoka 634 1.1 ahoka static void 635 1.1 ahoka nand_address_row(device_t self, size_t row) 636 1.1 ahoka { 637 1.1 ahoka struct nand_softc *sc = device_private(self); 638 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 639 1.7 ahoka int i; 640 1.1 ahoka 641 1.1 ahoka /* XXX TODO */ 642 1.1 ahoka row >>= chip->nc_page_shift; 643 1.1 ahoka 644 1.1 ahoka /* Write the row (page) address */ 645 1.1 ahoka for (i = 0; i < chip->nc_addr_cycles_row; i++, row >>= 8) 646 1.1 ahoka nand_address(self, row & 0xff); 647 1.1 ahoka } 648 1.1 ahoka 649 1.1 ahoka static inline uint8_t 650 1.1 ahoka nand_get_status(device_t self) 651 1.1 ahoka { 652 1.1 ahoka uint8_t status; 653 1.1 ahoka 654 1.1 ahoka nand_command(self, ONFI_READ_STATUS); 655 1.1 ahoka nand_busy(self); 656 1.12 ahoka nand_read_1(self, &status); 657 1.1 ahoka 658 1.1 ahoka return status; 659 1.1 ahoka } 660 1.1 ahoka 661 1.1 ahoka static bool 662 1.1 ahoka nand_check_wp(device_t self) 663 1.1 ahoka { 664 1.25 kiyohara if (nand_get_status(self) & ONFI_STATUS_WP) 665 1.1 ahoka return false; 666 1.1 ahoka else 667 1.1 ahoka return true; 668 1.1 ahoka } 669 1.1 ahoka 670 1.1 ahoka static void 671 1.7 ahoka nand_prepare_read(device_t self, flash_off_t row, flash_off_t column) 672 1.1 ahoka { 673 1.1 ahoka nand_command(self, ONFI_READ); 674 1.1 ahoka nand_address_column(self, row, column); 675 1.1 ahoka nand_command(self, ONFI_READ_START); 676 1.1 ahoka 677 1.1 ahoka nand_busy(self); 678 1.1 ahoka } 679 1.1 ahoka 680 1.6 ahoka /* read a page with ecc correction, default implementation */ 681 1.1 ahoka int 682 1.6 ahoka nand_default_read_page(device_t self, size_t offset, uint8_t *data) 683 1.1 ahoka { 684 1.1 ahoka struct nand_softc *sc = device_private(self); 685 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 686 1.1 ahoka size_t b, bs, e, cs; 687 1.1 ahoka uint8_t *ecc; 688 1.1 ahoka int result; 689 1.1 ahoka 690 1.1 ahoka nand_prepare_read(self, offset, 0); 691 1.1 ahoka 692 1.1 ahoka bs = chip->nc_ecc->necc_block_size; 693 1.1 ahoka cs = chip->nc_ecc->necc_code_size; 694 1.1 ahoka 695 1.1 ahoka /* decide if we access by 8 or 16 bits */ 696 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) { 697 1.1 ahoka for (b = 0, e = 0; b < chip->nc_page_size; b += bs, e += cs) { 698 1.1 ahoka nand_ecc_prepare(self, NAND_ECC_READ); 699 1.12 ahoka nand_read_buf_2(self, data + b, bs); 700 1.1 ahoka nand_ecc_compute(self, data + b, 701 1.1 ahoka chip->nc_ecc_cache + e); 702 1.1 ahoka } 703 1.1 ahoka } else { 704 1.1 ahoka for (b = 0, e = 0; b < chip->nc_page_size; b += bs, e += cs) { 705 1.1 ahoka nand_ecc_prepare(self, NAND_ECC_READ); 706 1.12 ahoka nand_read_buf_1(self, data + b, bs); 707 1.1 ahoka nand_ecc_compute(self, data + b, 708 1.1 ahoka chip->nc_ecc_cache + e); 709 1.1 ahoka } 710 1.1 ahoka } 711 1.1 ahoka 712 1.2 ahoka /* for debugging new drivers */ 713 1.2 ahoka #if 0 714 1.2 ahoka nand_dump_data("page", data, chip->nc_page_size); 715 1.2 ahoka #endif 716 1.1 ahoka 717 1.1 ahoka nand_read_oob(self, offset, chip->nc_oob_cache); 718 1.1 ahoka ecc = chip->nc_oob_cache + chip->nc_ecc->necc_offset; 719 1.1 ahoka 720 1.1 ahoka /* useful for debugging new ecc drivers */ 721 1.1 ahoka #if 0 722 1.1 ahoka printf("dumping ecc %d\n--------------\n", chip->nc_ecc->necc_steps); 723 1.1 ahoka for (e = 0; e < chip->nc_ecc->necc_steps; e++) { 724 1.1 ahoka printf("0x"); 725 1.1 ahoka for (b = 0; b < cs; b++) { 726 1.1 ahoka printf("%.2hhx", ecc[e+b]); 727 1.1 ahoka } 728 1.1 ahoka printf(" 0x"); 729 1.1 ahoka for (b = 0; b < cs; b++) { 730 1.1 ahoka printf("%.2hhx", chip->nc_ecc_cache[e+b]); 731 1.1 ahoka } 732 1.1 ahoka printf("\n"); 733 1.1 ahoka } 734 1.1 ahoka printf("--------------\n"); 735 1.1 ahoka #endif 736 1.1 ahoka 737 1.1 ahoka for (b = 0, e = 0; b < chip->nc_page_size; b += bs, e += cs) { 738 1.1 ahoka result = nand_ecc_correct(self, data + b, ecc + e, 739 1.1 ahoka chip->nc_ecc_cache + e); 740 1.1 ahoka 741 1.1 ahoka switch (result) { 742 1.1 ahoka case NAND_ECC_OK: 743 1.1 ahoka break; 744 1.1 ahoka case NAND_ECC_CORRECTED: 745 1.1 ahoka aprint_error_dev(self, 746 1.1 ahoka "data corrected with ECC at page offset 0x%jx " 747 1.20 pgoyette "block %zu\n", (uintmax_t)offset, b); 748 1.1 ahoka break; 749 1.1 ahoka case NAND_ECC_TWOBIT: 750 1.1 ahoka aprint_error_dev(self, 751 1.1 ahoka "uncorrectable ECC error at page offset 0x%jx " 752 1.20 pgoyette "block %zu\n", (uintmax_t)offset, b); 753 1.1 ahoka return EIO; 754 1.1 ahoka break; 755 1.1 ahoka case NAND_ECC_INVALID: 756 1.1 ahoka aprint_error_dev(self, 757 1.1 ahoka "invalid ECC in oob at page offset 0x%jx " 758 1.20 pgoyette "block %zu\n", (uintmax_t)offset, b); 759 1.1 ahoka return EIO; 760 1.1 ahoka break; 761 1.1 ahoka default: 762 1.1 ahoka panic("invalid ECC correction errno"); 763 1.1 ahoka } 764 1.1 ahoka } 765 1.1 ahoka 766 1.1 ahoka return 0; 767 1.1 ahoka } 768 1.1 ahoka 769 1.6 ahoka int 770 1.6 ahoka nand_default_program_page(device_t self, size_t page, const uint8_t *data) 771 1.1 ahoka { 772 1.1 ahoka struct nand_softc *sc = device_private(self); 773 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 774 1.1 ahoka size_t bs, cs, e, b; 775 1.1 ahoka uint8_t status; 776 1.1 ahoka uint8_t *ecc; 777 1.1 ahoka 778 1.1 ahoka nand_command(self, ONFI_PAGE_PROGRAM); 779 1.1 ahoka nand_address_column(self, page, 0); 780 1.1 ahoka 781 1.1 ahoka nand_busy(self); 782 1.1 ahoka 783 1.1 ahoka bs = chip->nc_ecc->necc_block_size; 784 1.1 ahoka cs = chip->nc_ecc->necc_code_size; 785 1.1 ahoka ecc = chip->nc_oob_cache + chip->nc_ecc->necc_offset; 786 1.1 ahoka 787 1.1 ahoka /* XXX code duplication */ 788 1.1 ahoka /* decide if we access by 8 or 16 bits */ 789 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) { 790 1.1 ahoka for (b = 0, e = 0; b < chip->nc_page_size; b += bs, e += cs) { 791 1.1 ahoka nand_ecc_prepare(self, NAND_ECC_WRITE); 792 1.12 ahoka nand_write_buf_2(self, data + b, bs); 793 1.1 ahoka nand_ecc_compute(self, data + b, ecc + e); 794 1.1 ahoka } 795 1.1 ahoka /* write oob with ecc correction code */ 796 1.12 ahoka nand_write_buf_2(self, chip->nc_oob_cache, 797 1.1 ahoka chip->nc_spare_size); 798 1.1 ahoka } else { 799 1.1 ahoka for (b = 0, e = 0; b < chip->nc_page_size; b += bs, e += cs) { 800 1.1 ahoka nand_ecc_prepare(self, NAND_ECC_WRITE); 801 1.12 ahoka nand_write_buf_1(self, data + b, bs); 802 1.1 ahoka nand_ecc_compute(self, data + b, ecc + e); 803 1.1 ahoka } 804 1.1 ahoka /* write oob with ecc correction code */ 805 1.12 ahoka nand_write_buf_1(self, chip->nc_oob_cache, 806 1.1 ahoka chip->nc_spare_size); 807 1.1 ahoka } 808 1.1 ahoka 809 1.1 ahoka nand_command(self, ONFI_PAGE_PROGRAM_START); 810 1.1 ahoka 811 1.1 ahoka nand_busy(self); 812 1.1 ahoka 813 1.2 ahoka /* for debugging ecc */ 814 1.1 ahoka #if 0 815 1.1 ahoka printf("dumping ecc %d\n--------------\n", chip->nc_ecc->necc_steps); 816 1.1 ahoka for (e = 0; e < chip->nc_ecc->necc_steps; e++) { 817 1.1 ahoka printf("0x"); 818 1.1 ahoka for (b = 0; b < cs; b++) { 819 1.1 ahoka printf("%.2hhx", ecc[e+b]); 820 1.1 ahoka } 821 1.1 ahoka printf("\n"); 822 1.1 ahoka } 823 1.1 ahoka printf("--------------\n"); 824 1.1 ahoka #endif 825 1.1 ahoka 826 1.1 ahoka status = nand_get_status(self); 827 1.1 ahoka KASSERT(status & ONFI_STATUS_RDY); 828 1.1 ahoka if (status & ONFI_STATUS_FAIL) { 829 1.1 ahoka aprint_error_dev(self, "page program failed!\n"); 830 1.1 ahoka return EIO; 831 1.1 ahoka } 832 1.1 ahoka 833 1.1 ahoka return 0; 834 1.1 ahoka } 835 1.1 ahoka 836 1.6 ahoka /* read the OOB of a page */ 837 1.1 ahoka int 838 1.6 ahoka nand_read_oob(device_t self, size_t page, uint8_t *oob) 839 1.1 ahoka { 840 1.1 ahoka struct nand_softc *sc = device_private(self); 841 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 842 1.1 ahoka 843 1.1 ahoka nand_prepare_read(self, page, chip->nc_page_size); 844 1.1 ahoka 845 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) 846 1.12 ahoka nand_read_buf_2(self, oob, chip->nc_spare_size); 847 1.1 ahoka else 848 1.12 ahoka nand_read_buf_1(self, oob, chip->nc_spare_size); 849 1.1 ahoka 850 1.2 ahoka /* for debugging drivers */ 851 1.2 ahoka #if 0 852 1.2 ahoka nand_dump_data("oob", oob, chip->nc_spare_size); 853 1.2 ahoka #endif 854 1.1 ahoka 855 1.1 ahoka return 0; 856 1.1 ahoka } 857 1.1 ahoka 858 1.1 ahoka static int 859 1.1 ahoka nand_write_oob(device_t self, size_t offset, const void *oob) 860 1.1 ahoka { 861 1.1 ahoka struct nand_softc *sc = device_private(self); 862 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 863 1.1 ahoka uint8_t status; 864 1.1 ahoka 865 1.1 ahoka nand_command(self, ONFI_PAGE_PROGRAM); 866 1.1 ahoka nand_address_column(self, offset, chip->nc_page_size); 867 1.1 ahoka nand_command(self, ONFI_PAGE_PROGRAM_START); 868 1.1 ahoka 869 1.1 ahoka nand_busy(self); 870 1.1 ahoka 871 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) 872 1.12 ahoka nand_write_buf_2(self, oob, chip->nc_spare_size); 873 1.1 ahoka else 874 1.12 ahoka nand_write_buf_1(self, oob, chip->nc_spare_size); 875 1.1 ahoka 876 1.1 ahoka status = nand_get_status(self); 877 1.1 ahoka KASSERT(status & ONFI_STATUS_RDY); 878 1.1 ahoka if (status & ONFI_STATUS_FAIL) 879 1.1 ahoka return EIO; 880 1.1 ahoka else 881 1.1 ahoka return 0; 882 1.1 ahoka } 883 1.1 ahoka 884 1.1 ahoka void 885 1.1 ahoka nand_markbad(device_t self, size_t offset) 886 1.1 ahoka { 887 1.1 ahoka struct nand_softc *sc = device_private(self); 888 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 889 1.23 christos flash_off_t blockoffset; 890 1.1 ahoka #ifdef NAND_BBT 891 1.7 ahoka flash_off_t block; 892 1.1 ahoka 893 1.1 ahoka block = offset / chip->nc_block_size; 894 1.1 ahoka 895 1.1 ahoka nand_bbt_block_markbad(self, block); 896 1.1 ahoka #endif 897 1.1 ahoka blockoffset = offset & chip->nc_block_mask; 898 1.1 ahoka 899 1.1 ahoka /* check if it is already marked bad */ 900 1.1 ahoka if (nand_isbad(self, blockoffset)) 901 1.1 ahoka return; 902 1.1 ahoka 903 1.1 ahoka nand_read_oob(self, blockoffset, chip->nc_oob_cache); 904 1.1 ahoka 905 1.1 ahoka chip->nc_oob_cache[chip->nc_badmarker_offs] = 0x00; 906 1.1 ahoka chip->nc_oob_cache[chip->nc_badmarker_offs + 1] = 0x00; 907 1.1 ahoka 908 1.1 ahoka nand_write_oob(self, blockoffset, chip->nc_oob_cache); 909 1.1 ahoka } 910 1.1 ahoka 911 1.1 ahoka bool 912 1.7 ahoka nand_isfactorybad(device_t self, flash_off_t offset) 913 1.1 ahoka { 914 1.1 ahoka struct nand_softc *sc = device_private(self); 915 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 916 1.7 ahoka flash_off_t block, first_page, last_page, page; 917 1.1 ahoka int i; 918 1.1 ahoka 919 1.1 ahoka /* Check for factory bad blocks first 920 1.1 ahoka * Factory bad blocks are marked in the first or last 921 1.1 ahoka * page of the blocks, see: ONFI 2.2, 3.2.2. 922 1.1 ahoka */ 923 1.1 ahoka block = offset / chip->nc_block_size; 924 1.1 ahoka first_page = block * chip->nc_block_size; 925 1.1 ahoka last_page = (block + 1) * chip->nc_block_size 926 1.1 ahoka - chip->nc_page_size; 927 1.1 ahoka 928 1.1 ahoka for (i = 0, page = first_page; i < 2; i++, page = last_page) { 929 1.1 ahoka /* address OOB */ 930 1.1 ahoka nand_prepare_read(self, page, chip->nc_page_size); 931 1.1 ahoka 932 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) { 933 1.1 ahoka uint16_t word; 934 1.12 ahoka nand_read_2(self, &word); 935 1.1 ahoka if (word == 0x0000) 936 1.1 ahoka return true; 937 1.1 ahoka } else { 938 1.1 ahoka uint8_t byte; 939 1.12 ahoka nand_read_1(self, &byte); 940 1.1 ahoka if (byte == 0x00) 941 1.1 ahoka return true; 942 1.1 ahoka } 943 1.1 ahoka } 944 1.1 ahoka 945 1.1 ahoka return false; 946 1.1 ahoka } 947 1.1 ahoka 948 1.1 ahoka bool 949 1.7 ahoka nand_iswornoutbad(device_t self, flash_off_t offset) 950 1.1 ahoka { 951 1.1 ahoka struct nand_softc *sc = device_private(self); 952 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 953 1.7 ahoka flash_off_t block; 954 1.1 ahoka 955 1.1 ahoka /* we inspect the first page of the block */ 956 1.1 ahoka block = offset & chip->nc_block_mask; 957 1.1 ahoka 958 1.1 ahoka /* Linux/u-boot compatible badblock handling */ 959 1.1 ahoka if (chip->nc_flags & NC_BUSWIDTH_16) { 960 1.1 ahoka uint16_t word, mark; 961 1.1 ahoka 962 1.1 ahoka nand_prepare_read(self, block, 963 1.1 ahoka chip->nc_page_size + (chip->nc_badmarker_offs & 0xfe)); 964 1.1 ahoka 965 1.12 ahoka nand_read_2(self, &word); 966 1.1 ahoka mark = htole16(word); 967 1.1 ahoka if (chip->nc_badmarker_offs & 0x01) 968 1.1 ahoka mark >>= 8; 969 1.1 ahoka if ((mark & 0xff) != 0xff) 970 1.1 ahoka return true; 971 1.1 ahoka } else { 972 1.1 ahoka uint8_t byte; 973 1.1 ahoka 974 1.1 ahoka nand_prepare_read(self, block, 975 1.1 ahoka chip->nc_page_size + chip->nc_badmarker_offs); 976 1.1 ahoka 977 1.12 ahoka nand_read_1(self, &byte); 978 1.1 ahoka if (byte != 0xff) 979 1.1 ahoka return true; 980 1.1 ahoka } 981 1.1 ahoka 982 1.1 ahoka return false; 983 1.1 ahoka } 984 1.1 ahoka 985 1.1 ahoka bool 986 1.7 ahoka nand_isbad(device_t self, flash_off_t offset) 987 1.1 ahoka { 988 1.1 ahoka #ifdef NAND_BBT 989 1.1 ahoka struct nand_softc *sc = device_private(self); 990 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 991 1.7 ahoka flash_off_t block; 992 1.1 ahoka 993 1.1 ahoka block = offset / chip->nc_block_size; 994 1.1 ahoka 995 1.1 ahoka return nand_bbt_block_isbad(self, block); 996 1.1 ahoka #else 997 1.1 ahoka /* ONFI host requirement */ 998 1.1 ahoka if (nand_isfactorybad(self, offset)) 999 1.1 ahoka return true; 1000 1.1 ahoka 1001 1.1 ahoka /* Look for Linux/U-Boot compatible bad marker */ 1002 1.1 ahoka if (nand_iswornoutbad(self, offset)) 1003 1.1 ahoka return true; 1004 1.1 ahoka 1005 1.1 ahoka return false; 1006 1.1 ahoka #endif 1007 1.1 ahoka } 1008 1.1 ahoka 1009 1.1 ahoka int 1010 1.1 ahoka nand_erase_block(device_t self, size_t offset) 1011 1.1 ahoka { 1012 1.1 ahoka uint8_t status; 1013 1.1 ahoka 1014 1.1 ahoka /* xxx calculate first page of block for address? */ 1015 1.1 ahoka 1016 1.1 ahoka nand_command(self, ONFI_BLOCK_ERASE); 1017 1.1 ahoka nand_address_row(self, offset); 1018 1.1 ahoka nand_command(self, ONFI_BLOCK_ERASE_START); 1019 1.1 ahoka 1020 1.1 ahoka nand_busy(self); 1021 1.1 ahoka 1022 1.1 ahoka status = nand_get_status(self); 1023 1.1 ahoka KASSERT(status & ONFI_STATUS_RDY); 1024 1.1 ahoka if (status & ONFI_STATUS_FAIL) { 1025 1.1 ahoka aprint_error_dev(self, "block erase failed!\n"); 1026 1.1 ahoka nand_markbad(self, offset); 1027 1.1 ahoka return EIO; 1028 1.1 ahoka } else { 1029 1.1 ahoka return 0; 1030 1.1 ahoka } 1031 1.1 ahoka } 1032 1.1 ahoka 1033 1.1 ahoka /* default functions for driver development */ 1034 1.1 ahoka 1035 1.1 ahoka /* default ECC using hamming code of 256 byte chunks */ 1036 1.1 ahoka int 1037 1.1 ahoka nand_default_ecc_compute(device_t self, const uint8_t *data, uint8_t *code) 1038 1.1 ahoka { 1039 1.1 ahoka hamming_compute_256(data, code); 1040 1.1 ahoka 1041 1.1 ahoka return 0; 1042 1.1 ahoka } 1043 1.1 ahoka 1044 1.1 ahoka int 1045 1.1 ahoka nand_default_ecc_correct(device_t self, uint8_t *data, const uint8_t *origcode, 1046 1.1 ahoka const uint8_t *compcode) 1047 1.1 ahoka { 1048 1.1 ahoka return hamming_correct_256(data, origcode, compcode); 1049 1.1 ahoka } 1050 1.1 ahoka 1051 1.1 ahoka void 1052 1.1 ahoka nand_default_select(device_t self, bool enable) 1053 1.1 ahoka { 1054 1.1 ahoka /* do nothing */ 1055 1.1 ahoka return; 1056 1.1 ahoka } 1057 1.1 ahoka 1058 1.1 ahoka /* implementation of the block device API */ 1059 1.1 ahoka 1060 1.14 ahoka int 1061 1.15 cliff nand_flash_submit(device_t self, struct buf * const bp) 1062 1.14 ahoka { 1063 1.14 ahoka struct nand_softc *sc = device_private(self); 1064 1.14 ahoka 1065 1.14 ahoka return flash_io_submit(&sc->sc_flash_io, bp); 1066 1.14 ahoka } 1067 1.14 ahoka 1068 1.1 ahoka /* 1069 1.1 ahoka * handle (page) unaligned write to nand 1070 1.1 ahoka */ 1071 1.1 ahoka static int 1072 1.7 ahoka nand_flash_write_unaligned(device_t self, flash_off_t offset, size_t len, 1073 1.1 ahoka size_t *retlen, const uint8_t *buf) 1074 1.1 ahoka { 1075 1.1 ahoka struct nand_softc *sc = device_private(self); 1076 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1077 1.7 ahoka flash_off_t first, last, firstoff; 1078 1.1 ahoka const uint8_t *bufp; 1079 1.7 ahoka flash_off_t addr; 1080 1.1 ahoka size_t left, count; 1081 1.8 ahoka int error = 0, i; 1082 1.1 ahoka 1083 1.1 ahoka first = offset & chip->nc_page_mask; 1084 1.1 ahoka firstoff = offset & ~chip->nc_page_mask; 1085 1.1 ahoka /* XXX check if this should be len - 1 */ 1086 1.1 ahoka last = (offset + len) & chip->nc_page_mask; 1087 1.1 ahoka count = last - first + 1; 1088 1.1 ahoka 1089 1.1 ahoka addr = first; 1090 1.1 ahoka *retlen = 0; 1091 1.1 ahoka 1092 1.8 ahoka mutex_enter(&sc->sc_device_lock); 1093 1.1 ahoka if (count == 1) { 1094 1.1 ahoka if (nand_isbad(self, addr)) { 1095 1.1 ahoka aprint_error_dev(self, 1096 1.1 ahoka "nand_flash_write_unaligned: " 1097 1.1 ahoka "bad block encountered\n"); 1098 1.8 ahoka error = EIO; 1099 1.8 ahoka goto out; 1100 1.1 ahoka } 1101 1.1 ahoka 1102 1.1 ahoka error = nand_read_page(self, addr, chip->nc_page_cache); 1103 1.8 ahoka if (error) { 1104 1.8 ahoka goto out; 1105 1.8 ahoka } 1106 1.1 ahoka 1107 1.1 ahoka memcpy(chip->nc_page_cache + firstoff, buf, len); 1108 1.1 ahoka 1109 1.1 ahoka error = nand_program_page(self, addr, chip->nc_page_cache); 1110 1.8 ahoka if (error) { 1111 1.8 ahoka goto out; 1112 1.8 ahoka } 1113 1.1 ahoka 1114 1.1 ahoka *retlen = len; 1115 1.8 ahoka goto out; 1116 1.1 ahoka } 1117 1.1 ahoka 1118 1.1 ahoka bufp = buf; 1119 1.1 ahoka left = len; 1120 1.1 ahoka 1121 1.1 ahoka for (i = 0; i < count && left != 0; i++) { 1122 1.1 ahoka if (nand_isbad(self, addr)) { 1123 1.1 ahoka aprint_error_dev(self, 1124 1.1 ahoka "nand_flash_write_unaligned: " 1125 1.1 ahoka "bad block encountered\n"); 1126 1.8 ahoka error = EIO; 1127 1.8 ahoka goto out; 1128 1.1 ahoka } 1129 1.1 ahoka 1130 1.1 ahoka if (i == 0) { 1131 1.1 ahoka error = nand_read_page(self, 1132 1.1 ahoka addr, chip->nc_page_cache); 1133 1.8 ahoka if (error) { 1134 1.8 ahoka goto out; 1135 1.8 ahoka } 1136 1.1 ahoka 1137 1.1 ahoka memcpy(chip->nc_page_cache + firstoff, 1138 1.1 ahoka bufp, chip->nc_page_size - firstoff); 1139 1.12 ahoka 1140 1.1 ahoka printf("program page: %s: %d\n", __FILE__, __LINE__); 1141 1.1 ahoka error = nand_program_page(self, 1142 1.1 ahoka addr, chip->nc_page_cache); 1143 1.8 ahoka if (error) { 1144 1.8 ahoka goto out; 1145 1.8 ahoka } 1146 1.1 ahoka 1147 1.1 ahoka bufp += chip->nc_page_size - firstoff; 1148 1.1 ahoka left -= chip->nc_page_size - firstoff; 1149 1.1 ahoka *retlen += chip->nc_page_size - firstoff; 1150 1.1 ahoka 1151 1.1 ahoka } else if (i == count - 1) { 1152 1.1 ahoka error = nand_read_page(self, 1153 1.1 ahoka addr, chip->nc_page_cache); 1154 1.8 ahoka if (error) { 1155 1.8 ahoka goto out; 1156 1.8 ahoka } 1157 1.1 ahoka 1158 1.1 ahoka memcpy(chip->nc_page_cache, bufp, left); 1159 1.1 ahoka 1160 1.1 ahoka error = nand_program_page(self, 1161 1.1 ahoka addr, chip->nc_page_cache); 1162 1.8 ahoka if (error) { 1163 1.8 ahoka goto out; 1164 1.8 ahoka } 1165 1.1 ahoka 1166 1.1 ahoka *retlen += left; 1167 1.1 ahoka KASSERT(left < chip->nc_page_size); 1168 1.1 ahoka 1169 1.1 ahoka } else { 1170 1.1 ahoka /* XXX debug */ 1171 1.1 ahoka if (left > chip->nc_page_size) { 1172 1.20 pgoyette printf("left: %zu, i: %d, count: %zu\n", 1173 1.19 ahoka left, i, count); 1174 1.1 ahoka } 1175 1.1 ahoka KASSERT(left > chip->nc_page_size); 1176 1.1 ahoka 1177 1.1 ahoka error = nand_program_page(self, addr, bufp); 1178 1.8 ahoka if (error) { 1179 1.8 ahoka goto out; 1180 1.8 ahoka } 1181 1.1 ahoka 1182 1.1 ahoka bufp += chip->nc_page_size; 1183 1.1 ahoka left -= chip->nc_page_size; 1184 1.1 ahoka *retlen += chip->nc_page_size; 1185 1.1 ahoka } 1186 1.1 ahoka 1187 1.1 ahoka addr += chip->nc_page_size; 1188 1.1 ahoka } 1189 1.1 ahoka 1190 1.1 ahoka KASSERT(*retlen == len); 1191 1.8 ahoka out: 1192 1.8 ahoka mutex_exit(&sc->sc_device_lock); 1193 1.1 ahoka 1194 1.8 ahoka return error; 1195 1.1 ahoka } 1196 1.1 ahoka 1197 1.1 ahoka int 1198 1.7 ahoka nand_flash_write(device_t self, flash_off_t offset, size_t len, size_t *retlen, 1199 1.1 ahoka const uint8_t *buf) 1200 1.1 ahoka { 1201 1.1 ahoka struct nand_softc *sc = device_private(self); 1202 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1203 1.1 ahoka const uint8_t *bufp; 1204 1.1 ahoka size_t pages, page; 1205 1.1 ahoka daddr_t addr; 1206 1.1 ahoka int error = 0; 1207 1.1 ahoka 1208 1.1 ahoka if ((offset + len) > chip->nc_size) { 1209 1.1 ahoka DPRINTF(("nand_flash_write: write (off: 0x%jx, len: %ju)," 1210 1.1 ahoka " is over device size (0x%jx)\n", 1211 1.1 ahoka (uintmax_t)offset, (uintmax_t)len, 1212 1.1 ahoka (uintmax_t)chip->nc_size)); 1213 1.1 ahoka return EINVAL; 1214 1.1 ahoka } 1215 1.1 ahoka 1216 1.1 ahoka if (len % chip->nc_page_size != 0 || 1217 1.1 ahoka offset % chip->nc_page_size != 0) { 1218 1.1 ahoka return nand_flash_write_unaligned(self, 1219 1.1 ahoka offset, len, retlen, buf); 1220 1.1 ahoka } 1221 1.1 ahoka 1222 1.1 ahoka pages = len / chip->nc_page_size; 1223 1.1 ahoka KASSERT(pages != 0); 1224 1.1 ahoka *retlen = 0; 1225 1.1 ahoka 1226 1.1 ahoka addr = offset; 1227 1.1 ahoka bufp = buf; 1228 1.1 ahoka 1229 1.1 ahoka mutex_enter(&sc->sc_device_lock); 1230 1.1 ahoka for (page = 0; page < pages; page++) { 1231 1.1 ahoka /* do we need this check here? */ 1232 1.1 ahoka if (nand_isbad(self, addr)) { 1233 1.1 ahoka aprint_error_dev(self, 1234 1.1 ahoka "nand_flash_write: bad block encountered\n"); 1235 1.1 ahoka 1236 1.1 ahoka error = EIO; 1237 1.1 ahoka goto out; 1238 1.1 ahoka } 1239 1.1 ahoka 1240 1.1 ahoka error = nand_program_page(self, addr, bufp); 1241 1.8 ahoka if (error) { 1242 1.1 ahoka goto out; 1243 1.8 ahoka } 1244 1.1 ahoka 1245 1.1 ahoka addr += chip->nc_page_size; 1246 1.1 ahoka bufp += chip->nc_page_size; 1247 1.1 ahoka *retlen += chip->nc_page_size; 1248 1.1 ahoka } 1249 1.1 ahoka out: 1250 1.1 ahoka mutex_exit(&sc->sc_device_lock); 1251 1.19 ahoka DPRINTF(("page programming: retlen: %" PRIu32 ", len: %" PRIu32 "\n", *retlen, len)); 1252 1.1 ahoka 1253 1.1 ahoka return error; 1254 1.1 ahoka } 1255 1.1 ahoka 1256 1.1 ahoka /* 1257 1.1 ahoka * handle (page) unaligned read from nand 1258 1.1 ahoka */ 1259 1.1 ahoka static int 1260 1.1 ahoka nand_flash_read_unaligned(device_t self, size_t offset, 1261 1.1 ahoka size_t len, size_t *retlen, uint8_t *buf) 1262 1.1 ahoka { 1263 1.1 ahoka struct nand_softc *sc = device_private(self); 1264 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1265 1.1 ahoka daddr_t first, last, count, firstoff; 1266 1.1 ahoka uint8_t *bufp; 1267 1.1 ahoka daddr_t addr; 1268 1.1 ahoka size_t left; 1269 1.1 ahoka int error = 0, i; 1270 1.1 ahoka 1271 1.1 ahoka first = offset & chip->nc_page_mask; 1272 1.1 ahoka firstoff = offset & ~chip->nc_page_mask; 1273 1.1 ahoka last = (offset + len) & chip->nc_page_mask; 1274 1.1 ahoka count = (last - first) / chip->nc_page_size + 1; 1275 1.1 ahoka 1276 1.1 ahoka addr = first; 1277 1.1 ahoka bufp = buf; 1278 1.1 ahoka left = len; 1279 1.1 ahoka *retlen = 0; 1280 1.1 ahoka 1281 1.1 ahoka mutex_enter(&sc->sc_device_lock); 1282 1.1 ahoka if (count == 1) { 1283 1.1 ahoka error = nand_read_page(self, addr, chip->nc_page_cache); 1284 1.8 ahoka if (error) { 1285 1.1 ahoka goto out; 1286 1.8 ahoka } 1287 1.1 ahoka 1288 1.1 ahoka memcpy(bufp, chip->nc_page_cache + firstoff, len); 1289 1.1 ahoka 1290 1.1 ahoka *retlen = len; 1291 1.1 ahoka goto out; 1292 1.1 ahoka } 1293 1.1 ahoka 1294 1.1 ahoka for (i = 0; i < count && left != 0; i++) { 1295 1.1 ahoka error = nand_read_page(self, addr, chip->nc_page_cache); 1296 1.8 ahoka if (error) { 1297 1.1 ahoka goto out; 1298 1.8 ahoka } 1299 1.1 ahoka 1300 1.1 ahoka if (i == 0) { 1301 1.1 ahoka memcpy(bufp, chip->nc_page_cache + firstoff, 1302 1.1 ahoka chip->nc_page_size - firstoff); 1303 1.1 ahoka 1304 1.1 ahoka bufp += chip->nc_page_size - firstoff; 1305 1.1 ahoka left -= chip->nc_page_size - firstoff; 1306 1.1 ahoka *retlen += chip->nc_page_size - firstoff; 1307 1.1 ahoka 1308 1.1 ahoka } else if (i == count - 1) { 1309 1.1 ahoka memcpy(bufp, chip->nc_page_cache, left); 1310 1.1 ahoka *retlen += left; 1311 1.1 ahoka KASSERT(left < chip->nc_page_size); 1312 1.1 ahoka 1313 1.1 ahoka } else { 1314 1.1 ahoka memcpy(bufp, chip->nc_page_cache, chip->nc_page_size); 1315 1.1 ahoka 1316 1.1 ahoka bufp += chip->nc_page_size; 1317 1.1 ahoka left -= chip->nc_page_size; 1318 1.1 ahoka *retlen += chip->nc_page_size; 1319 1.1 ahoka } 1320 1.1 ahoka 1321 1.1 ahoka addr += chip->nc_page_size; 1322 1.1 ahoka } 1323 1.1 ahoka KASSERT(*retlen == len); 1324 1.1 ahoka out: 1325 1.1 ahoka mutex_exit(&sc->sc_device_lock); 1326 1.1 ahoka 1327 1.1 ahoka return error; 1328 1.1 ahoka } 1329 1.1 ahoka 1330 1.1 ahoka int 1331 1.7 ahoka nand_flash_read(device_t self, flash_off_t offset, size_t len, size_t *retlen, 1332 1.1 ahoka uint8_t *buf) 1333 1.1 ahoka { 1334 1.1 ahoka struct nand_softc *sc = device_private(self); 1335 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1336 1.1 ahoka uint8_t *bufp; 1337 1.1 ahoka size_t addr; 1338 1.1 ahoka size_t i, pages; 1339 1.1 ahoka int error = 0; 1340 1.1 ahoka 1341 1.1 ahoka *retlen = 0; 1342 1.1 ahoka 1343 1.19 ahoka DPRINTF(("nand_flash_read: off: 0x%jx, len: %" PRIu32 "\n", 1344 1.1 ahoka (uintmax_t)offset, len)); 1345 1.1 ahoka 1346 1.1 ahoka if (__predict_false((offset + len) > chip->nc_size)) { 1347 1.19 ahoka DPRINTF(("nand_flash_read: read (off: 0x%jx, len: %" PRIu32 ")," 1348 1.1 ahoka " is over device size (%ju)\n", (uintmax_t)offset, 1349 1.1 ahoka len, (uintmax_t)chip->nc_size)); 1350 1.1 ahoka return EINVAL; 1351 1.1 ahoka } 1352 1.1 ahoka 1353 1.1 ahoka /* Handle unaligned access, shouldnt be needed when using the 1354 1.1 ahoka * block device, as strategy handles it, so only low level 1355 1.1 ahoka * accesses will use this path 1356 1.1 ahoka */ 1357 1.2 ahoka /* XXX^2 */ 1358 1.2 ahoka #if 0 1359 1.2 ahoka if (len < chip->nc_page_size) 1360 1.2 ahoka panic("TODO page size is larger than read size"); 1361 1.2 ahoka #endif 1362 1.1 ahoka 1363 1.1 ahoka if (len % chip->nc_page_size != 0 || 1364 1.1 ahoka offset % chip->nc_page_size != 0) { 1365 1.1 ahoka return nand_flash_read_unaligned(self, 1366 1.1 ahoka offset, len, retlen, buf); 1367 1.1 ahoka } 1368 1.1 ahoka 1369 1.1 ahoka bufp = buf; 1370 1.1 ahoka addr = offset; 1371 1.1 ahoka pages = len / chip->nc_page_size; 1372 1.1 ahoka 1373 1.1 ahoka mutex_enter(&sc->sc_device_lock); 1374 1.1 ahoka for (i = 0; i < pages; i++) { 1375 1.2 ahoka /* XXX do we need this check here? */ 1376 1.1 ahoka if (nand_isbad(self, addr)) { 1377 1.1 ahoka aprint_error_dev(self, "bad block encountered\n"); 1378 1.1 ahoka error = EIO; 1379 1.1 ahoka goto out; 1380 1.1 ahoka } 1381 1.1 ahoka error = nand_read_page(self, addr, bufp); 1382 1.1 ahoka if (error) 1383 1.1 ahoka goto out; 1384 1.1 ahoka 1385 1.1 ahoka bufp += chip->nc_page_size; 1386 1.1 ahoka addr += chip->nc_page_size; 1387 1.1 ahoka *retlen += chip->nc_page_size; 1388 1.1 ahoka } 1389 1.1 ahoka out: 1390 1.1 ahoka mutex_exit(&sc->sc_device_lock); 1391 1.1 ahoka 1392 1.1 ahoka return error; 1393 1.1 ahoka } 1394 1.1 ahoka 1395 1.1 ahoka int 1396 1.16 martin nand_flash_isbad(device_t self, flash_off_t ofs, bool *is_bad) 1397 1.1 ahoka { 1398 1.1 ahoka struct nand_softc *sc = device_private(self); 1399 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1400 1.1 ahoka bool result; 1401 1.1 ahoka 1402 1.1 ahoka if (ofs > chip->nc_size) { 1403 1.1 ahoka DPRINTF(("nand_flash_isbad: offset 0x%jx is larger than" 1404 1.1 ahoka " device size (0x%jx)\n", (uintmax_t)ofs, 1405 1.1 ahoka (uintmax_t)chip->nc_size)); 1406 1.1 ahoka return EINVAL; 1407 1.1 ahoka } 1408 1.1 ahoka 1409 1.1 ahoka if (ofs % chip->nc_block_size != 0) { 1410 1.15 cliff DPRINTF(("offset (0x%jx) is not a multiple of block size " 1411 1.7 ahoka "(%ju)", 1412 1.7 ahoka (uintmax_t)ofs, (uintmax_t)chip->nc_block_size)); 1413 1.7 ahoka return EINVAL; 1414 1.1 ahoka } 1415 1.1 ahoka 1416 1.1 ahoka mutex_enter(&sc->sc_device_lock); 1417 1.1 ahoka result = nand_isbad(self, ofs); 1418 1.1 ahoka mutex_exit(&sc->sc_device_lock); 1419 1.1 ahoka 1420 1.16 martin *is_bad = result; 1421 1.11 rmind 1422 1.7 ahoka return 0; 1423 1.1 ahoka } 1424 1.1 ahoka 1425 1.1 ahoka int 1426 1.7 ahoka nand_flash_markbad(device_t self, flash_off_t ofs) 1427 1.1 ahoka { 1428 1.1 ahoka struct nand_softc *sc = device_private(self); 1429 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1430 1.1 ahoka 1431 1.1 ahoka if (ofs > chip->nc_size) { 1432 1.1 ahoka DPRINTF(("nand_flash_markbad: offset 0x%jx is larger than" 1433 1.1 ahoka " device size (0x%jx)\n", ofs, 1434 1.1 ahoka (uintmax_t)chip->nc_size)); 1435 1.1 ahoka return EINVAL; 1436 1.1 ahoka } 1437 1.1 ahoka 1438 1.1 ahoka if (ofs % chip->nc_block_size != 0) { 1439 1.15 cliff panic("offset (%ju) is not a multiple of block size (%ju)", 1440 1.1 ahoka (uintmax_t)ofs, (uintmax_t)chip->nc_block_size); 1441 1.1 ahoka } 1442 1.1 ahoka 1443 1.1 ahoka mutex_enter(&sc->sc_device_lock); 1444 1.1 ahoka nand_markbad(self, ofs); 1445 1.1 ahoka mutex_exit(&sc->sc_device_lock); 1446 1.1 ahoka 1447 1.1 ahoka return 0; 1448 1.1 ahoka } 1449 1.1 ahoka 1450 1.1 ahoka int 1451 1.1 ahoka nand_flash_erase(device_t self, 1452 1.1 ahoka struct flash_erase_instruction *ei) 1453 1.1 ahoka { 1454 1.1 ahoka struct nand_softc *sc = device_private(self); 1455 1.1 ahoka struct nand_chip *chip = &sc->sc_chip; 1456 1.7 ahoka flash_off_t addr; 1457 1.8 ahoka int error = 0; 1458 1.1 ahoka 1459 1.1 ahoka if (ei->ei_addr < 0 || ei->ei_len < chip->nc_block_size) 1460 1.1 ahoka return EINVAL; 1461 1.1 ahoka 1462 1.1 ahoka if (ei->ei_addr + ei->ei_len > chip->nc_size) { 1463 1.1 ahoka DPRINTF(("nand_flash_erase: erase address is over the end" 1464 1.1 ahoka " of the device\n")); 1465 1.1 ahoka return EINVAL; 1466 1.1 ahoka } 1467 1.1 ahoka 1468 1.1 ahoka if (ei->ei_addr % chip->nc_block_size != 0) { 1469 1.1 ahoka aprint_error_dev(self, 1470 1.1 ahoka "nand_flash_erase: ei_addr (%ju) is not" 1471 1.15 cliff " a multiple of block size (%ju)", 1472 1.1 ahoka (uintmax_t)ei->ei_addr, 1473 1.1 ahoka (uintmax_t)chip->nc_block_size); 1474 1.1 ahoka return EINVAL; 1475 1.1 ahoka } 1476 1.1 ahoka 1477 1.1 ahoka if (ei->ei_len % chip->nc_block_size != 0) { 1478 1.1 ahoka aprint_error_dev(self, 1479 1.1 ahoka "nand_flash_erase: ei_len (%ju) is not" 1480 1.15 cliff " a multiple of block size (%ju)", 1481 1.15 cliff (uintmax_t)ei->ei_len, 1482 1.1 ahoka (uintmax_t)chip->nc_block_size); 1483 1.1 ahoka return EINVAL; 1484 1.1 ahoka } 1485 1.1 ahoka 1486 1.1 ahoka mutex_enter(&sc->sc_device_lock); 1487 1.1 ahoka addr = ei->ei_addr; 1488 1.1 ahoka while (addr < ei->ei_addr + ei->ei_len) { 1489 1.1 ahoka if (nand_isbad(self, addr)) { 1490 1.1 ahoka aprint_error_dev(self, "bad block encountered\n"); 1491 1.1 ahoka ei->ei_state = FLASH_ERASE_FAILED; 1492 1.8 ahoka error = EIO; 1493 1.8 ahoka goto out; 1494 1.1 ahoka } 1495 1.1 ahoka 1496 1.1 ahoka error = nand_erase_block(self, addr); 1497 1.1 ahoka if (error) { 1498 1.1 ahoka ei->ei_state = FLASH_ERASE_FAILED; 1499 1.8 ahoka goto out; 1500 1.1 ahoka } 1501 1.1 ahoka 1502 1.1 ahoka addr += chip->nc_block_size; 1503 1.1 ahoka } 1504 1.1 ahoka mutex_exit(&sc->sc_device_lock); 1505 1.1 ahoka 1506 1.1 ahoka ei->ei_state = FLASH_ERASE_DONE; 1507 1.8 ahoka if (ei->ei_callback != NULL) { 1508 1.1 ahoka ei->ei_callback(ei); 1509 1.8 ahoka } 1510 1.1 ahoka 1511 1.1 ahoka return 0; 1512 1.8 ahoka out: 1513 1.8 ahoka mutex_exit(&sc->sc_device_lock); 1514 1.8 ahoka 1515 1.8 ahoka return error; 1516 1.1 ahoka } 1517 1.1 ahoka 1518 1.1 ahoka MODULE(MODULE_CLASS_DRIVER, nand, "flash"); 1519 1.1 ahoka 1520 1.1 ahoka #ifdef _MODULE 1521 1.1 ahoka #include "ioconf.c" 1522 1.1 ahoka #endif 1523 1.1 ahoka 1524 1.1 ahoka static int 1525 1.1 ahoka nand_modcmd(modcmd_t cmd, void *opaque) 1526 1.1 ahoka { 1527 1.1 ahoka switch (cmd) { 1528 1.1 ahoka case MODULE_CMD_INIT: 1529 1.1 ahoka #ifdef _MODULE 1530 1.1 ahoka return config_init_component(cfdriver_ioconf_nand, 1531 1.1 ahoka cfattach_ioconf_nand, cfdata_ioconf_nand); 1532 1.1 ahoka #else 1533 1.1 ahoka return 0; 1534 1.1 ahoka #endif 1535 1.1 ahoka case MODULE_CMD_FINI: 1536 1.1 ahoka #ifdef _MODULE 1537 1.1 ahoka return config_fini_component(cfdriver_ioconf_nand, 1538 1.1 ahoka cfattach_ioconf_nand, cfdata_ioconf_nand); 1539 1.1 ahoka #else 1540 1.1 ahoka return 0; 1541 1.1 ahoka #endif 1542 1.1 ahoka default: 1543 1.1 ahoka return ENOTTY; 1544 1.1 ahoka } 1545 1.1 ahoka } 1546