Home | History | Annotate | Line # | Download | only in altmem
altmem.c revision 1.3
      1 /* $NetBSD: altmem.c,v 1.3 2014/07/25 08:02:19 dholland Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2009 Jared D. McNeill <jmcneill (at) invisible.ca>
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. The name of the author may not be used to endorse or promote products
     13  *    derived from this software without specific prior written permission.
     14  *
     15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     20  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     21  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     22  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     23  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     25  * SUCH DAMAGE.
     26  */
     27 
     28 #include <sys/cdefs.h>
     29 __KERNEL_RCSID(0, "$NetBSD: altmem.c,v 1.3 2014/07/25 08:02:19 dholland Exp $");
     30 #include <sys/param.h>
     31 #include <sys/types.h>
     32 #include <sys/device.h>
     33 #include <sys/conf.h>
     34 #include <sys/buf.h>
     35 #include <sys/disklabel.h>
     36 #include <sys/disk.h>
     37 
     38 #include <dev/altmem/altmemvar.h>
     39 
     40 struct altmem_softc {
     41 	device_t	sc_dev;
     42 
     43 	struct disk	sc_dkdev;
     44 
     45 	void		*sc_cookie;
     46 	const struct altmem_memops *sc_memops;
     47 
     48 	size_t		sc_size;
     49 };
     50 
     51 static dev_type_open(altmemopen);
     52 static dev_type_close(altmemclose);
     53 static dev_type_read(altmemread);
     54 static dev_type_write(altmemwrite);
     55 static dev_type_ioctl(altmemioctl);
     56 static dev_type_strategy(altmemstrategy);
     57 static dev_type_size(altmemsize);
     58 
     59 static int	altmem_match(device_t, cfdata_t, void *);
     60 static void	altmem_attach(device_t, device_t, void *);
     61 
     62 const struct bdevsw altmem_bdevsw = {
     63         .d_open = altmemopen,
     64 	.d_close = altmemclose,
     65 	.d_strategy = altmemstrategy,
     66 	.d_ioctl = altmemioctl,
     67 	.d_dump = nodump,
     68 	.d_psize = altmemsize,
     69 	.d_discard = nodiscard,
     70 	.d_flag = D_DISK
     71 };
     72 const struct cdevsw altmem_cdevsw = {
     73 	.d_open = altmemopen,
     74 	.d_close = altmemclose,
     75 	.d_read = altmemread,
     76 	.d_write = altmemwrite,
     77 	.d_ioctl = altmemioctl,
     78 	.d_stop = nostop,
     79 	.d_tty = notty,
     80 	.d_poll = nopoll,
     81 	.d_mmap = nommap,
     82 	.d_kqfilter = nokqfilter,
     83 	.d_flag = D_DISK
     84 };
     85 static struct dkdriver altmemdkdriver = { altmemstrategy, minphys };
     86 extern struct cfdriver altmem_cd;
     87 
     88 CFATTACH_DECL_NEW(altmem, sizeof(struct altmem_softc), altmem_match,
     89     altmem_attach, NULL, NULL);
     90 
     91 static int
     92 altmem_match(device_t parent, cfdata_t match, void *opaque)
     93 {
     94 	return 1;
     95 }
     96 
     97 static void
     98 altmem_attach(device_t parent, device_t self, void *opaque)
     99 {
    100 	struct altmem_softc *sc = device_private(self);
    101 	struct altmem_attach_args *aaa = opaque;
    102 	char pbuf[9];
    103 
    104 	sc->sc_dev = self;
    105 	sc->sc_cookie = aaa->cookie;
    106 	sc->sc_memops = aaa->memops;
    107 	sc->sc_size = sc->sc_memops->getsize(sc->sc_cookie);
    108 
    109 	format_bytes(pbuf, sizeof(pbuf), sc->sc_size);
    110 
    111 	aprint_naive("\n");
    112 	aprint_normal(": %s\n", pbuf);
    113 
    114 	disk_init(&sc->sc_dkdev, device_xname(self), &altmemdkdriver);
    115 	disk_attach(&sc->sc_dkdev);
    116 }
    117 
    118 static int
    119 altmemsize(dev_t dev)
    120 {
    121 	struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(dev));
    122 	if (sc == NULL)
    123 		return 0;
    124 	return sc->sc_size >> DEV_BSHIFT;
    125 }
    126 
    127 static int
    128 altmemopen(dev_t dev, int flag, int fmt, struct lwp *l)
    129 {
    130 	struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(dev));
    131 	if (sc == NULL)
    132 		return ENXIO;
    133 	return 0;
    134 }
    135 
    136 static int
    137 altmemclose(dev_t dev, int flag, int fmt, struct lwp *l)
    138 {
    139 	return 0;
    140 }
    141 
    142 static int
    143 altmemread(dev_t dev, struct uio *uio, int flags)
    144 {
    145 	if (device_lookup_private(&altmem_cd, DISKUNIT(dev)) == NULL)
    146 		return ENXIO;
    147 	return physio(altmemstrategy, NULL, dev, B_READ, minphys, uio);
    148 }
    149 
    150 static int
    151 altmemwrite(dev_t dev, struct uio *uio, int flags)
    152 {
    153 	if (device_lookup_private(&altmem_cd, DISKUNIT(dev)) == NULL)
    154 		return ENXIO;
    155 	return physio(altmemstrategy, NULL, dev, B_WRITE, minphys, uio);
    156 }
    157 
    158 static void
    159 altmemstrategy(struct buf *bp)
    160 {
    161 	struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(bp->b_dev));
    162 
    163 	if (sc == NULL) {
    164 		bp->b_error = ENXIO;
    165 		biodone(bp);
    166 		return;
    167 	}
    168 	if (bp->b_bcount == 0) {
    169 		biodone(bp);
    170 		return;
    171 	}
    172 
    173 	sc->sc_memops->strategy(sc->sc_cookie, bp);
    174 	biodone(bp);
    175 }
    176 
    177 static int
    178 altmemioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
    179 {
    180 	struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(dev));
    181 	struct dkwedge_info *dkw;
    182 
    183 	switch (cmd) {
    184 	case DIOCGWEDGEINFO:
    185 		dkw = (void *)data;
    186 		strlcpy(dkw->dkw_devname, device_xname(sc->sc_dev),
    187 		    sizeof(dkw->dkw_devname));
    188 		strlcpy(dkw->dkw_wname, "altmem", sizeof(dkw->dkw_wname));
    189 		dkw->dkw_parent[0] = '\0';
    190 		dkw->dkw_offset = 0;
    191 		dkw->dkw_size = sc->sc_size >> DEV_BSHIFT;
    192 		strcpy(dkw->dkw_ptype, DKW_PTYPE_UNUSED);
    193 		break;
    194 	default:
    195 		return ENOTTY;
    196 	}
    197 	return 0;
    198 }
    199