Home | History | Annotate | Line # | Download | only in flash
flash.c revision 1.16.8.1
      1  1.16.8.1   thorpej /*	$NetBSD: flash.c,v 1.16.8.1 2021/08/04 23:24:58 thorpej Exp $	*/
      2       1.1     ahoka 
      3       1.1     ahoka /*-
      4       1.1     ahoka  * Copyright (c) 2011 Department of Software Engineering,
      5       1.1     ahoka  *		      University of Szeged, Hungary
      6       1.1     ahoka  * Copyright (c) 2011 Adam Hoka <ahoka (at) NetBSD.org>
      7       1.1     ahoka  * Copyright (c) 2010 David Tengeri <dtengeri (at) inf.u-szeged.hu>
      8       1.1     ahoka  * All rights reserved.
      9       1.1     ahoka  *
     10       1.1     ahoka  * This code is derived from software contributed to The NetBSD Foundation
     11       1.1     ahoka  * by the Department of Software Engineering, University of Szeged, Hungary
     12       1.1     ahoka  *
     13       1.1     ahoka  * Redistribution and use in source and binary forms, with or without
     14       1.1     ahoka  * modification, are permitted provided that the following conditions
     15       1.1     ahoka  * are met:
     16       1.1     ahoka  * 1. Redistributions of source code must retain the above copyright
     17       1.1     ahoka  *    notice, this list of conditions and the following disclaimer.
     18       1.1     ahoka  * 2. Redistributions in binary form must reproduce the above copyright
     19       1.1     ahoka  *    notice, this list of conditions and the following disclaimer in the
     20       1.1     ahoka  *    documentation and/or other materials provided with the distribution.
     21       1.1     ahoka  *
     22       1.1     ahoka  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23       1.1     ahoka  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24       1.1     ahoka  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25       1.1     ahoka  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26       1.1     ahoka  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     27       1.1     ahoka  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     28       1.1     ahoka  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     29       1.1     ahoka  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     30       1.1     ahoka  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31       1.1     ahoka  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32       1.1     ahoka  * SUCH DAMAGE.
     33       1.1     ahoka  */
     34       1.1     ahoka 
     35       1.1     ahoka /*-
     36       1.1     ahoka  * Framework for storage devices based on Flash technology
     37       1.1     ahoka  */
     38       1.1     ahoka 
     39       1.1     ahoka #include <sys/cdefs.h>
     40  1.16.8.1   thorpej __KERNEL_RCSID(0, "$NetBSD: flash.c,v 1.16.8.1 2021/08/04 23:24:58 thorpej Exp $");
     41       1.1     ahoka 
     42       1.1     ahoka #include <sys/param.h>
     43       1.1     ahoka #include <sys/types.h>
     44       1.1     ahoka #include <sys/proc.h>
     45       1.1     ahoka #include <sys/errno.h>
     46       1.1     ahoka #include <sys/ioctl.h>
     47       1.1     ahoka #include <sys/device.h>
     48       1.1     ahoka #include <sys/conf.h>
     49       1.1     ahoka #include <sys/kmem.h>
     50       1.1     ahoka #include <sys/uio.h>
     51       1.1     ahoka #include <sys/kernel.h>
     52       1.1     ahoka 
     53       1.1     ahoka #include <sys/atomic.h>
     54       1.1     ahoka #include <sys/buf.h>
     55       1.1     ahoka #include <sys/bufq.h>
     56       1.1     ahoka #include <sys/disk.h>
     57       1.1     ahoka #include <sys/disklabel.h>
     58       1.1     ahoka #include <sys/malloc.h>
     59       1.1     ahoka #include <sys/reboot.h>
     60       1.1     ahoka 
     61      1.13  riastrad #include "ioconf.h"
     62      1.13  riastrad 
     63       1.1     ahoka #include <sys/flashio.h>
     64       1.1     ahoka #include "flash.h"
     65       1.1     ahoka 
     66       1.1     ahoka #ifdef FLASH_DEBUG
     67       1.7     ahoka int flashdebug = FLASH_DEBUG;
     68       1.1     ahoka #endif
     69       1.1     ahoka 
     70       1.1     ahoka dev_type_open(flashopen);
     71       1.1     ahoka dev_type_close(flashclose);
     72       1.1     ahoka dev_type_read(flashread);
     73       1.1     ahoka dev_type_write(flashwrite);
     74       1.1     ahoka dev_type_ioctl(flashioctl);
     75       1.1     ahoka dev_type_strategy(flashstrategy);
     76       1.1     ahoka dev_type_dump(flashdump);
     77       1.1     ahoka 
     78       1.1     ahoka int flash_print(void *aux, const char *pnp);
     79       1.1     ahoka 
     80       1.1     ahoka bool flash_shutdown(device_t dev, int how);
     81       1.1     ahoka int flash_nsectors(struct buf *bp);
     82       1.1     ahoka int flash_sector(struct buf *bp);
     83       1.1     ahoka 
     84       1.1     ahoka int flash_match(device_t parent, cfdata_t match, void *aux);
     85       1.1     ahoka void flash_attach(device_t parent, device_t self, void *aux);
     86       1.1     ahoka int flash_detach(device_t device, int flags);
     87       1.1     ahoka 
     88       1.1     ahoka CFATTACH_DECL_NEW(flash, sizeof(struct flash_softc),
     89       1.1     ahoka     flash_match, flash_attach, flash_detach, NULL);
     90       1.1     ahoka 
     91       1.1     ahoka /**
     92       1.1     ahoka  * Block device's operation
     93       1.1     ahoka  */
     94       1.1     ahoka const struct bdevsw flash_bdevsw = {
     95       1.1     ahoka 	.d_open = flashopen,
     96       1.1     ahoka 	.d_close = flashclose,
     97       1.1     ahoka 	.d_strategy = flashstrategy,
     98       1.1     ahoka 	.d_ioctl = flashioctl,
     99       1.1     ahoka 	.d_dump = flashdump,
    100       1.6     ahoka 	.d_psize = nosize,
    101      1.11  dholland 	.d_discard = nodiscard,	/* XXX this driver probably wants a discard */
    102       1.1     ahoka 	.d_flag = D_DISK | D_MPSAFE
    103       1.1     ahoka };
    104       1.1     ahoka 
    105       1.1     ahoka /**
    106       1.1     ahoka  * Character device's operations
    107       1.1     ahoka  */
    108       1.1     ahoka const struct cdevsw flash_cdevsw = {
    109       1.1     ahoka 	.d_open = flashopen,
    110       1.1     ahoka 	.d_close = flashclose,
    111       1.1     ahoka 	.d_read = flashread,
    112       1.1     ahoka 	.d_write = flashwrite,
    113       1.1     ahoka 	.d_ioctl = flashioctl,
    114       1.1     ahoka 	.d_stop = nostop,
    115       1.1     ahoka 	.d_tty = notty,
    116       1.1     ahoka 	.d_poll = nopoll,
    117       1.1     ahoka 	.d_mmap = nommap,
    118       1.1     ahoka 	.d_kqfilter = nokqfilter,
    119      1.12  dholland 	.d_discard = nodiscard,
    120       1.1     ahoka 	.d_flag = D_DISK | D_MPSAFE
    121       1.1     ahoka };
    122       1.1     ahoka 
    123       1.1     ahoka /* ARGSUSED */
    124       1.1     ahoka int
    125       1.1     ahoka flash_match(device_t parent, cfdata_t match, void *aux)
    126       1.1     ahoka {
    127       1.1     ahoka 	/* pseudo device, always attaches */
    128       1.1     ahoka 	return 1;
    129       1.1     ahoka }
    130       1.1     ahoka 
    131       1.1     ahoka /* ARGSUSED */
    132       1.1     ahoka void
    133       1.1     ahoka flash_attach(device_t parent, device_t self, void *aux)
    134       1.1     ahoka {
    135       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    136       1.8     cliff 	struct flash_attach_args * const faa = aux;
    137       1.1     ahoka 	char pbuf[2][sizeof("9999 KB")];
    138       1.1     ahoka 
    139       1.1     ahoka 	sc->sc_dev = self;
    140       1.1     ahoka 	sc->sc_parent_dev = parent;
    141       1.1     ahoka 	sc->flash_if = faa->flash_if;
    142       1.7     ahoka 	sc->sc_partinfo = faa->partinfo;
    143       1.1     ahoka 	sc->hw_softc = device_private(parent);
    144       1.1     ahoka 
    145       1.7     ahoka 	format_bytes(pbuf[0], sizeof(pbuf[0]), sc->sc_partinfo.part_size);
    146       1.1     ahoka 	format_bytes(pbuf[1], sizeof(pbuf[1]), sc->flash_if->erasesize);
    147       1.1     ahoka 
    148       1.1     ahoka 	aprint_naive("\n");
    149       1.6     ahoka 
    150      1.14  jmcneill 	aprint_normal(": partition");
    151      1.14  jmcneill 	if (sc->sc_partinfo.part_name != NULL)
    152      1.14  jmcneill 		aprint_normal(" \"%s\"", sc->sc_partinfo.part_name);
    153       1.6     ahoka 
    154      1.14  jmcneill 	aprint_normal(", size %s, offset %#jx",
    155      1.14  jmcneill 		pbuf[0], (uintmax_t)sc->sc_partinfo.part_offset);
    156       1.1     ahoka 
    157       1.7     ahoka 	if (sc->sc_partinfo.part_flags & FLASH_PART_READONLY) {
    158       1.1     ahoka 		sc->sc_readonly = true;
    159       1.1     ahoka 		aprint_normal(", read only");
    160       1.1     ahoka 	} else {
    161       1.1     ahoka 		sc->sc_readonly = false;
    162       1.1     ahoka 	}
    163       1.1     ahoka 
    164       1.1     ahoka 	aprint_normal("\n");
    165       1.1     ahoka 
    166       1.7     ahoka 	if (sc->sc_partinfo.part_size == 0) {
    167       1.1     ahoka 		aprint_error_dev(self,
    168       1.1     ahoka 		    "partition size must be larger than 0\n");
    169       1.1     ahoka 		return;
    170       1.1     ahoka 	}
    171       1.6     ahoka 
    172       1.1     ahoka 	switch (sc->flash_if->type) {
    173       1.1     ahoka 	case FLASH_TYPE_NOR:
    174       1.1     ahoka 		aprint_normal_dev(sc->sc_dev,
    175       1.1     ahoka 		    "erase size %s bytes, write size %d bytes\n",
    176       1.1     ahoka 		    pbuf[1], sc->flash_if->writesize);
    177       1.1     ahoka 		break;
    178       1.1     ahoka 
    179       1.1     ahoka 	case FLASH_TYPE_NAND:
    180       1.1     ahoka 	default:
    181       1.1     ahoka 		aprint_normal_dev(sc->sc_dev,
    182       1.1     ahoka 		    "erase size %s, page size %d bytes, write size %d bytes\n",
    183       1.1     ahoka 		    pbuf[1], sc->flash_if->page_size,
    184       1.1     ahoka 		    sc->flash_if->writesize);
    185       1.1     ahoka 		break;
    186       1.1     ahoka 	}
    187       1.6     ahoka 
    188       1.1     ahoka 	if (!pmf_device_register1(sc->sc_dev, NULL, NULL, flash_shutdown))
    189       1.1     ahoka 		aprint_error_dev(sc->sc_dev,
    190       1.1     ahoka 		    "couldn't establish power handler\n");
    191       1.1     ahoka }
    192       1.1     ahoka 
    193       1.1     ahoka int
    194       1.1     ahoka flash_detach(device_t device, int flags)
    195       1.1     ahoka {
    196       1.8     cliff 	struct flash_softc * const sc = device_private(device);
    197       1.1     ahoka 
    198       1.1     ahoka 	pmf_device_deregister(sc->sc_dev);
    199       1.1     ahoka 
    200       1.1     ahoka 	/* freeing flash_if is our responsibility */
    201       1.1     ahoka 	kmem_free(sc->flash_if, sizeof(*sc->flash_if));
    202       1.6     ahoka 
    203       1.1     ahoka 	return 0;
    204       1.1     ahoka }
    205       1.1     ahoka 
    206       1.1     ahoka int
    207       1.1     ahoka flash_print(void *aux, const char *pnp)
    208       1.1     ahoka {
    209       1.1     ahoka 	struct flash_attach_args *arg;
    210       1.1     ahoka 	const char *type;
    211       1.1     ahoka 
    212       1.1     ahoka 	if (pnp != NULL) {
    213       1.1     ahoka 		arg = aux;
    214       1.1     ahoka 		switch (arg->flash_if->type) {
    215       1.1     ahoka 		case FLASH_TYPE_NOR:
    216       1.1     ahoka 			type = "NOR";
    217       1.1     ahoka 			break;
    218       1.1     ahoka 		case FLASH_TYPE_NAND:
    219       1.1     ahoka 			type = "NAND";
    220       1.1     ahoka 			break;
    221       1.1     ahoka 		default:
    222       1.1     ahoka 			panic("flash_print: unknown type %d",
    223       1.1     ahoka 			    arg->flash_if->type);
    224       1.1     ahoka 		}
    225       1.1     ahoka 		aprint_normal("%s flash at %s", type, pnp);
    226       1.1     ahoka 	}
    227       1.1     ahoka 	return UNCONF;
    228       1.1     ahoka }
    229       1.1     ahoka 
    230       1.1     ahoka device_t
    231       1.8     cliff flash_attach_mi(struct flash_interface * const flash_if, device_t device)
    232       1.1     ahoka {
    233       1.1     ahoka 	struct flash_attach_args arg;
    234       1.1     ahoka 
    235       1.1     ahoka #ifdef DIAGNOSTIC
    236       1.1     ahoka 	if (flash_if == NULL) {
    237       1.1     ahoka 		aprint_error("flash_attach_mi: NULL\n");
    238       1.1     ahoka 		return 0;
    239       1.1     ahoka 	}
    240       1.1     ahoka #endif
    241       1.1     ahoka 	arg.flash_if = flash_if;
    242       1.1     ahoka 
    243      1.16   thorpej 	return config_found(device, &arg, flash_print,
    244  1.16.8.1   thorpej 	    CFARGS(.iattr = "flashbus"));
    245       1.1     ahoka }
    246       1.1     ahoka 
    247       1.1     ahoka /**
    248       1.1     ahoka  * flash_open - open the character device
    249       1.1     ahoka  * Checks if there is a driver registered to the minor number of the open
    250       1.1     ahoka  * request.
    251       1.1     ahoka  */
    252       1.1     ahoka int
    253       1.8     cliff flashopen(dev_t dev, int flags, int fmt, lwp_t *l)
    254       1.1     ahoka {
    255       1.1     ahoka 	int unit = minor(dev);
    256       1.1     ahoka 	struct flash_softc *sc;
    257       1.1     ahoka 
    258       1.7     ahoka 	FLDPRINTFN(1, ("flash: opening device unit %d\n", unit));
    259       1.1     ahoka 
    260       1.1     ahoka 	if ((sc = device_lookup_private(&flash_cd, unit)) == NULL)
    261       1.1     ahoka 		return ENXIO;
    262       1.1     ahoka 
    263       1.1     ahoka 	/* TODO return eperm if want to open for writing a read only dev */
    264       1.1     ahoka 
    265       1.1     ahoka 	/* reset buffer length */
    266       1.1     ahoka //	sc->sc_cache->fc_len = 0;
    267       1.6     ahoka 
    268       1.1     ahoka 	return 0;
    269       1.1     ahoka }
    270       1.1     ahoka 
    271       1.1     ahoka /**
    272       1.1     ahoka  * flash_close - close device
    273       1.1     ahoka  * We don't have to release any resources, so just return 0.
    274       1.1     ahoka  */
    275       1.1     ahoka int
    276       1.8     cliff flashclose(dev_t dev, int flags, int fmt, lwp_t *l)
    277       1.1     ahoka {
    278       1.1     ahoka 	int unit = minor(dev);
    279       1.1     ahoka 	struct flash_softc *sc;
    280       1.1     ahoka 	int err;
    281       1.1     ahoka 
    282       1.7     ahoka 	FLDPRINTFN(1, ("flash: closing flash device unit %d\n", unit));
    283       1.1     ahoka 
    284       1.1     ahoka 	if ((sc = device_lookup_private(&flash_cd, unit)) == NULL)
    285       1.1     ahoka 		return ENXIO;
    286       1.1     ahoka 
    287       1.1     ahoka 	if (!sc->sc_readonly) {
    288       1.1     ahoka 		err = flash_sync(sc->sc_dev);
    289       1.1     ahoka 		if (err)
    290       1.1     ahoka 			return err;
    291       1.1     ahoka 	}
    292       1.6     ahoka 
    293       1.1     ahoka 	return 0;
    294       1.1     ahoka }
    295       1.1     ahoka 
    296       1.1     ahoka /**
    297       1.1     ahoka  * flash_read - read from character device
    298       1.8     cliff  * This function uses the registered driver's read function to read the
    299       1.8     cliff  * requested length to * a buffer and then moves this buffer to userspace.
    300       1.1     ahoka  */
    301       1.1     ahoka int
    302       1.8     cliff flashread(dev_t dev, struct uio * const uio, int flag)
    303       1.1     ahoka {
    304       1.1     ahoka 	return physio(flashstrategy, NULL, dev, B_READ, minphys, uio);
    305       1.1     ahoka }
    306       1.1     ahoka 
    307       1.1     ahoka /**
    308       1.1     ahoka  * flash_write - write to character device
    309       1.1     ahoka  * This function moves the data into a buffer from userspace to kernel space,
    310       1.1     ahoka  * then uses the registered driver's write function to write out the data to
    311       1.1     ahoka  * the media.
    312       1.1     ahoka  */
    313       1.1     ahoka int
    314       1.8     cliff flashwrite(dev_t dev, struct uio * const uio, int flag)
    315       1.1     ahoka {
    316       1.1     ahoka 	return physio(flashstrategy, NULL, dev, B_WRITE, minphys, uio);
    317       1.1     ahoka }
    318       1.1     ahoka 
    319       1.1     ahoka void
    320       1.8     cliff flashstrategy(struct buf * const bp)
    321       1.1     ahoka {
    322       1.1     ahoka 	struct flash_softc *sc;
    323       1.1     ahoka 	const struct flash_interface *flash_if;
    324       1.1     ahoka 	const struct flash_partition *part;
    325       1.1     ahoka 	int unit, device_blks;
    326       1.1     ahoka 
    327       1.1     ahoka 	unit = minor(bp->b_dev);
    328       1.1     ahoka 	sc = device_lookup_private(&flash_cd, unit);
    329       1.1     ahoka 	if (sc == NULL) {
    330       1.1     ahoka 		bp->b_error = ENXIO;
    331       1.1     ahoka 		goto done;
    332       1.1     ahoka 	}
    333       1.1     ahoka 
    334       1.1     ahoka 	flash_if = sc->flash_if;
    335       1.7     ahoka 	part = &sc->sc_partinfo;
    336       1.1     ahoka 
    337       1.1     ahoka 	/* divider */
    338       1.1     ahoka 	KASSERT(flash_if->writesize != 0);
    339       1.6     ahoka 
    340       1.1     ahoka 	aprint_debug_dev(sc->sc_dev, "flash_strategy()\n");
    341       1.1     ahoka 
    342       1.1     ahoka 	if (!(bp->b_flags & B_READ) && sc->sc_readonly) {
    343       1.1     ahoka 		bp->b_error = EACCES;
    344       1.1     ahoka 		goto done;
    345       1.1     ahoka 	}
    346       1.1     ahoka 
    347       1.1     ahoka 	/* check if length is not negative */
    348       1.1     ahoka 	if (bp->b_blkno < 0) {
    349       1.1     ahoka 		bp->b_error = EINVAL;
    350       1.1     ahoka 		goto done;
    351       1.1     ahoka 	}
    352       1.1     ahoka 
    353      1.15   msaitoh 	/* zero length i/o */
    354       1.1     ahoka 	if (bp->b_bcount == 0) {
    355       1.1     ahoka 		goto done;
    356       1.1     ahoka 	}
    357       1.1     ahoka 
    358       1.7     ahoka 	device_blks = sc->sc_partinfo.part_size / DEV_BSIZE;
    359       1.1     ahoka 	KASSERT(part->part_offset % DEV_BSIZE == 0);
    360       1.1     ahoka 	bp->b_rawblkno = bp->b_blkno + (part->part_offset / DEV_BSIZE);
    361       1.1     ahoka 
    362       1.1     ahoka 	if (bounds_check_with_mediasize(bp, DEV_BSIZE, device_blks) <= 0) {
    363       1.1     ahoka 		goto done;
    364       1.1     ahoka 	}
    365       1.1     ahoka 
    366       1.1     ahoka 	bp->b_resid = bp->b_bcount;
    367       1.1     ahoka 	flash_if->submit(sc->sc_parent_dev, bp);
    368       1.6     ahoka 
    369       1.1     ahoka 	return;
    370       1.1     ahoka done:
    371       1.1     ahoka 	bp->b_resid = bp->b_bcount;
    372       1.1     ahoka 	biodone(bp);
    373       1.1     ahoka }
    374       1.1     ahoka 
    375       1.1     ahoka /*
    376       1.1     ahoka  * Handle the ioctl for the device
    377       1.1     ahoka  */
    378       1.1     ahoka int
    379       1.8     cliff flashioctl(dev_t dev, u_long command, void * const data, int flags, lwp_t *l)
    380       1.1     ahoka {
    381       1.1     ahoka 	struct flash_erase_params *ep;
    382       1.1     ahoka 	struct flash_info_params *ip;
    383       1.1     ahoka 	struct flash_dump_params *dp;
    384       1.1     ahoka 	struct flash_badblock_params *bbp;
    385       1.1     ahoka 	struct flash_erase_instruction ei;
    386       1.1     ahoka 	struct flash_softc *sc;
    387       1.1     ahoka 	int unit, err;
    388       1.1     ahoka 	size_t retlen;
    389       1.3     ahoka 	flash_off_t offset;
    390       1.3     ahoka 	bool bad;
    391       1.1     ahoka 
    392       1.1     ahoka 	unit = minor(dev);
    393       1.1     ahoka 	if ((sc = device_lookup_private(&flash_cd, unit)) == NULL)
    394       1.1     ahoka 		return ENXIO;
    395       1.1     ahoka 
    396       1.1     ahoka 	err = 0;
    397       1.1     ahoka 	switch (command) {
    398       1.1     ahoka 	case FLASH_ERASE_BLOCK:
    399       1.1     ahoka 		/**
    400       1.1     ahoka 		 * Set up an erase instruction then call the registered
    401       1.1     ahoka 		 * driver's erase operation.
    402       1.1     ahoka 		 */
    403       1.1     ahoka 		ep = data;
    404       1.1     ahoka 
    405       1.1     ahoka 		if (sc->sc_readonly) {
    406       1.1     ahoka 			return EACCES;
    407       1.1     ahoka 		}
    408       1.1     ahoka 
    409       1.1     ahoka 		ei.ei_addr = ep->ep_addr;
    410       1.1     ahoka 		ei.ei_len = ep->ep_len;
    411       1.1     ahoka 		ei.ei_callback = NULL;
    412       1.6     ahoka 
    413       1.1     ahoka 		err = flash_erase(sc->sc_dev, &ei);
    414       1.1     ahoka 		if (err) {
    415       1.1     ahoka 			return err;
    416       1.1     ahoka 		}
    417       1.1     ahoka 
    418       1.1     ahoka 		break;
    419       1.1     ahoka 	case FLASH_BLOCK_ISBAD:
    420       1.1     ahoka 		/**
    421       1.1     ahoka 		 * Set up an erase instruction then call the registered
    422       1.1     ahoka 		 * driver's erase operation.
    423       1.1     ahoka 		 */
    424       1.1     ahoka 		bbp = data;
    425       1.1     ahoka 
    426       1.3     ahoka 		err = flash_block_isbad(sc->sc_dev, bbp->bbp_addr, &bad);
    427       1.3     ahoka 		if (err) {
    428       1.1     ahoka 			return err;
    429       1.1     ahoka 		}
    430       1.3     ahoka 		bbp->bbp_isbad = bad;
    431       1.1     ahoka 
    432       1.1     ahoka 		break;
    433       1.1     ahoka 	case FLASH_BLOCK_MARKBAD:
    434       1.1     ahoka 		bbp = data;
    435       1.1     ahoka 
    436       1.1     ahoka 		err = flash_block_markbad(sc->sc_dev, bbp->bbp_addr);
    437       1.1     ahoka 
    438       1.6     ahoka 		break;
    439       1.1     ahoka 	case FLASH_DUMP:
    440       1.1     ahoka 		dp = data;
    441       1.1     ahoka 		offset = dp->dp_block * sc->flash_if->erasesize;
    442       1.7     ahoka 		FLDPRINTF(("Reading from block: %jd len: %jd\n",
    443       1.1     ahoka 			(intmax_t )dp->dp_block, (intmax_t )dp->dp_len));
    444       1.1     ahoka 		err = flash_read(sc->sc_parent_dev, offset, dp->dp_len,
    445       1.1     ahoka 		    &retlen, dp->dp_buf);
    446       1.1     ahoka 		if (err)
    447       1.1     ahoka 			return err;
    448       1.1     ahoka 		if (retlen != dp->dp_len) {
    449       1.1     ahoka 			dp->dp_len = -1;
    450       1.1     ahoka 			dp->dp_buf = NULL;
    451       1.1     ahoka 		}
    452       1.1     ahoka 
    453       1.1     ahoka 		break;
    454       1.1     ahoka 	case FLASH_GET_INFO:
    455       1.1     ahoka 		ip = data;
    456       1.6     ahoka 
    457       1.1     ahoka 		ip->ip_page_size = sc->flash_if->page_size;
    458       1.1     ahoka 		ip->ip_erase_size = sc->flash_if->erasesize;
    459       1.1     ahoka 		ip->ip_flash_type = sc->flash_if->type;
    460       1.7     ahoka 		ip->ip_flash_size = sc->sc_partinfo.part_size;
    461       1.1     ahoka 		break;
    462       1.1     ahoka 	default:
    463       1.1     ahoka 		err = ENODEV;
    464       1.1     ahoka 	}
    465       1.1     ahoka 
    466       1.1     ahoka 	return err;
    467       1.1     ahoka }
    468       1.2  uebayasi 
    469       1.1     ahoka int
    470       1.1     ahoka flashdump(dev_t dev, daddr_t blkno, void *va, size_t size)
    471       1.1     ahoka {
    472       1.8     cliff 	return EACCES;
    473       1.1     ahoka }
    474       1.1     ahoka 
    475       1.1     ahoka bool
    476       1.1     ahoka flash_shutdown(device_t self, int how)
    477       1.1     ahoka {
    478       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    479       1.6     ahoka 
    480       1.1     ahoka 	if ((how & RB_NOSYNC) == 0 && !sc->sc_readonly)
    481       1.1     ahoka 		flash_sync(self);
    482       1.1     ahoka 
    483       1.1     ahoka 	return true;
    484       1.1     ahoka }
    485       1.1     ahoka 
    486       1.1     ahoka const struct flash_interface *
    487       1.1     ahoka flash_get_interface(dev_t dev)
    488       1.1     ahoka {
    489       1.1     ahoka 	struct flash_softc *sc;
    490       1.1     ahoka 	int unit;
    491       1.1     ahoka 
    492       1.1     ahoka 	unit = minor(dev);
    493       1.1     ahoka 	if ((sc = device_lookup_private(&flash_cd, unit)) == NULL)
    494       1.1     ahoka 		return NULL;
    495       1.1     ahoka 
    496       1.1     ahoka 	return sc->flash_if;
    497       1.1     ahoka }
    498       1.1     ahoka 
    499       1.1     ahoka const struct flash_softc *
    500       1.1     ahoka flash_get_softc(dev_t dev)
    501       1.1     ahoka {
    502       1.1     ahoka 	struct flash_softc *sc;
    503       1.1     ahoka 	int unit;
    504       1.1     ahoka 
    505       1.1     ahoka 	unit = minor(dev);
    506       1.1     ahoka 	sc = device_lookup_private(&flash_cd, unit);
    507       1.1     ahoka 
    508       1.1     ahoka 	return sc;
    509       1.1     ahoka }
    510       1.1     ahoka 
    511       1.1     ahoka device_t
    512       1.1     ahoka flash_get_device(dev_t dev)
    513       1.1     ahoka {
    514       1.1     ahoka 	struct flash_softc *sc;
    515       1.1     ahoka 	int unit;
    516       1.1     ahoka 
    517       1.1     ahoka 	unit = minor(dev);
    518       1.1     ahoka 	sc = device_lookup_private(&flash_cd, unit);
    519       1.1     ahoka 
    520       1.1     ahoka 	return sc->sc_dev;
    521       1.1     ahoka }
    522       1.1     ahoka 
    523       1.9     ahoka flash_size_t
    524       1.9     ahoka flash_get_size(dev_t dev)
    525       1.9     ahoka {
    526       1.9     ahoka 	const struct flash_softc *sc;
    527       1.9     ahoka 
    528       1.9     ahoka 	sc = flash_get_softc(dev);
    529       1.9     ahoka 
    530       1.9     ahoka 	return sc->sc_partinfo.part_size;
    531       1.9     ahoka }
    532       1.9     ahoka 
    533       1.1     ahoka int
    534       1.8     cliff flash_erase(device_t self, struct flash_erase_instruction * const ei)
    535       1.1     ahoka {
    536       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    537       1.1     ahoka 	KASSERT(ei != NULL);
    538       1.1     ahoka 	struct flash_erase_instruction e = *ei;
    539       1.1     ahoka 
    540       1.1     ahoka 	if (sc->sc_readonly)
    541       1.1     ahoka 		return EACCES;
    542       1.1     ahoka 
    543       1.1     ahoka 	/* adjust for flash partition */
    544       1.7     ahoka 	e.ei_addr += sc->sc_partinfo.part_offset;
    545       1.1     ahoka 
    546       1.1     ahoka 	/* bounds check for flash partition */
    547       1.7     ahoka 	if (e.ei_addr + e.ei_len > sc->sc_partinfo.part_size +
    548       1.7     ahoka 	    sc->sc_partinfo.part_offset)
    549       1.1     ahoka 		return EINVAL;
    550       1.6     ahoka 
    551       1.1     ahoka 	return sc->flash_if->erase(device_parent(self), &e);
    552       1.1     ahoka }
    553       1.1     ahoka 
    554       1.1     ahoka int
    555       1.8     cliff flash_read(device_t self, flash_off_t offset, size_t len, size_t * const retlen,
    556       1.8     cliff     uint8_t * const buf)
    557       1.1     ahoka {
    558       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    559       1.1     ahoka 
    560       1.7     ahoka 	offset += sc->sc_partinfo.part_offset;
    561       1.1     ahoka 
    562       1.7     ahoka 	if (offset + len > sc->sc_partinfo.part_size +
    563       1.7     ahoka 	    sc->sc_partinfo.part_offset)
    564       1.1     ahoka 		return EINVAL;
    565       1.1     ahoka 
    566       1.1     ahoka 	return sc->flash_if->read(device_parent(self),
    567       1.1     ahoka 	    offset, len, retlen, buf);
    568       1.1     ahoka }
    569       1.1     ahoka 
    570       1.1     ahoka int
    571       1.8     cliff flash_write(device_t self, flash_off_t offset, size_t len,
    572       1.8     cliff     size_t * const retlen, const uint8_t * const buf)
    573       1.1     ahoka {
    574       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    575       1.1     ahoka 
    576       1.1     ahoka 	if (sc->sc_readonly)
    577       1.1     ahoka 		return EACCES;
    578       1.1     ahoka 
    579       1.7     ahoka 	offset += sc->sc_partinfo.part_offset;
    580       1.1     ahoka 
    581       1.7     ahoka 	if (offset + len > sc->sc_partinfo.part_size +
    582       1.7     ahoka 	    sc->sc_partinfo.part_offset)
    583       1.1     ahoka 		return EINVAL;
    584       1.1     ahoka 
    585       1.1     ahoka 	return sc->flash_if->write(device_parent(self),
    586       1.1     ahoka 	    offset, len, retlen, buf);
    587       1.1     ahoka }
    588       1.1     ahoka 
    589       1.1     ahoka int
    590       1.3     ahoka flash_block_markbad(device_t self, flash_off_t offset)
    591       1.1     ahoka {
    592       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    593       1.1     ahoka 
    594       1.1     ahoka 	if (sc->sc_readonly)
    595       1.1     ahoka 		return EACCES;
    596       1.6     ahoka 
    597       1.7     ahoka 	offset += sc->sc_partinfo.part_offset;
    598       1.6     ahoka 
    599       1.1     ahoka 	if (offset + sc->flash_if->erasesize >=
    600       1.7     ahoka 	    sc->sc_partinfo.part_size +
    601       1.7     ahoka 	    sc->sc_partinfo.part_offset)
    602       1.1     ahoka 		return EINVAL;
    603       1.1     ahoka 
    604       1.1     ahoka 	return sc->flash_if->block_markbad(device_parent(self), offset);
    605       1.1     ahoka }
    606       1.1     ahoka 
    607       1.1     ahoka int
    608       1.8     cliff flash_block_isbad(device_t self, flash_off_t offset, bool * const bad)
    609       1.1     ahoka {
    610       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    611       1.6     ahoka 
    612       1.7     ahoka 	offset += sc->sc_partinfo.part_offset;
    613       1.1     ahoka 
    614       1.1     ahoka 	if (offset + sc->flash_if->erasesize >
    615       1.7     ahoka 	    sc->sc_partinfo.part_size +
    616       1.7     ahoka 	    sc->sc_partinfo.part_offset)
    617       1.1     ahoka 		return EINVAL;
    618       1.1     ahoka 
    619       1.3     ahoka 	return sc->flash_if->block_isbad(device_parent(self), offset, bad);
    620       1.1     ahoka }
    621       1.1     ahoka 
    622       1.1     ahoka int
    623       1.1     ahoka flash_sync(device_t self)
    624       1.1     ahoka {
    625       1.8     cliff 	struct flash_softc * const sc = device_private(self);
    626       1.6     ahoka 
    627       1.1     ahoka 	if (sc->sc_readonly)
    628       1.1     ahoka 		return EACCES;
    629       1.1     ahoka 
    630       1.1     ahoka 	/* noop now TODO: implement */
    631       1.1     ahoka 	return 0;
    632       1.1     ahoka }
    633       1.1     ahoka 
    634       1.1     ahoka MODULE(MODULE_CLASS_DRIVER, flash, NULL);
    635       1.1     ahoka 
    636       1.1     ahoka #ifdef _MODULE
    637       1.1     ahoka #include "ioconf.c"
    638       1.1     ahoka #endif
    639       1.1     ahoka 
    640       1.1     ahoka static int
    641       1.1     ahoka flash_modcmd(modcmd_t cmd, void *opaque)
    642       1.1     ahoka {
    643       1.1     ahoka 	int error = 0;
    644       1.1     ahoka #ifdef _MODULE
    645       1.1     ahoka 	int bmaj = -1, cmaj = -1;
    646       1.1     ahoka #endif
    647       1.1     ahoka 
    648       1.1     ahoka 	switch (cmd) {
    649       1.1     ahoka 	case MODULE_CMD_INIT:
    650       1.1     ahoka #ifdef _MODULE
    651       1.1     ahoka 		error = config_init_component(cfdriver_ioconf_flash,
    652       1.1     ahoka 		    cfattach_ioconf_flash, cfdata_ioconf_flash);
    653       1.1     ahoka 		if (error)
    654       1.1     ahoka 			return error;
    655       1.1     ahoka 		error = devsw_attach("flash", &flash_bdevsw, &bmaj,
    656       1.1     ahoka 		    &flash_cdevsw, &cmaj);
    657       1.1     ahoka 		if (error)
    658       1.1     ahoka 			config_fini_component(cfdriver_ioconf_flash,
    659       1.1     ahoka 			    cfattach_ioconf_flash, cfdata_ioconf_flash);
    660       1.1     ahoka #endif
    661       1.1     ahoka 		return error;
    662       1.1     ahoka 	case MODULE_CMD_FINI:
    663       1.1     ahoka #ifdef _MODULE
    664       1.1     ahoka 		devsw_detach(&flash_bdevsw, &flash_cdevsw);
    665       1.1     ahoka 		error = config_fini_component(cfdriver_ioconf_flash,
    666       1.1     ahoka 		    cfattach_ioconf_flash, cfdata_ioconf_flash);
    667       1.1     ahoka #endif
    668       1.1     ahoka 		return error;
    669       1.1     ahoka 	default:
    670       1.1     ahoka 		return ENOTTY;
    671       1.1     ahoka 	}
    672       1.1     ahoka }
    673