Home | History | Annotate | Line # | Download | only in nand
      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, &params)) {
    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