altmem.c revision 1.4
1 /* $NetBSD: altmem.c,v 1.4 2014/07/25 08:10:36 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.4 2014/07/25 08:10:36 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_discard = nodiscard, 84 .d_flag = D_DISK 85 }; 86 static struct dkdriver altmemdkdriver = { altmemstrategy, minphys }; 87 extern struct cfdriver altmem_cd; 88 89 CFATTACH_DECL_NEW(altmem, sizeof(struct altmem_softc), altmem_match, 90 altmem_attach, NULL, NULL); 91 92 static int 93 altmem_match(device_t parent, cfdata_t match, void *opaque) 94 { 95 return 1; 96 } 97 98 static void 99 altmem_attach(device_t parent, device_t self, void *opaque) 100 { 101 struct altmem_softc *sc = device_private(self); 102 struct altmem_attach_args *aaa = opaque; 103 char pbuf[9]; 104 105 sc->sc_dev = self; 106 sc->sc_cookie = aaa->cookie; 107 sc->sc_memops = aaa->memops; 108 sc->sc_size = sc->sc_memops->getsize(sc->sc_cookie); 109 110 format_bytes(pbuf, sizeof(pbuf), sc->sc_size); 111 112 aprint_naive("\n"); 113 aprint_normal(": %s\n", pbuf); 114 115 disk_init(&sc->sc_dkdev, device_xname(self), &altmemdkdriver); 116 disk_attach(&sc->sc_dkdev); 117 } 118 119 static int 120 altmemsize(dev_t dev) 121 { 122 struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(dev)); 123 if (sc == NULL) 124 return 0; 125 return sc->sc_size >> DEV_BSHIFT; 126 } 127 128 static int 129 altmemopen(dev_t dev, int flag, int fmt, struct lwp *l) 130 { 131 struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(dev)); 132 if (sc == NULL) 133 return ENXIO; 134 return 0; 135 } 136 137 static int 138 altmemclose(dev_t dev, int flag, int fmt, struct lwp *l) 139 { 140 return 0; 141 } 142 143 static int 144 altmemread(dev_t dev, struct uio *uio, int flags) 145 { 146 if (device_lookup_private(&altmem_cd, DISKUNIT(dev)) == NULL) 147 return ENXIO; 148 return physio(altmemstrategy, NULL, dev, B_READ, minphys, uio); 149 } 150 151 static int 152 altmemwrite(dev_t dev, struct uio *uio, int flags) 153 { 154 if (device_lookup_private(&altmem_cd, DISKUNIT(dev)) == NULL) 155 return ENXIO; 156 return physio(altmemstrategy, NULL, dev, B_WRITE, minphys, uio); 157 } 158 159 static void 160 altmemstrategy(struct buf *bp) 161 { 162 struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(bp->b_dev)); 163 164 if (sc == NULL) { 165 bp->b_error = ENXIO; 166 biodone(bp); 167 return; 168 } 169 if (bp->b_bcount == 0) { 170 biodone(bp); 171 return; 172 } 173 174 sc->sc_memops->strategy(sc->sc_cookie, bp); 175 biodone(bp); 176 } 177 178 static int 179 altmemioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l) 180 { 181 struct altmem_softc *sc = device_lookup_private(&altmem_cd, DISKUNIT(dev)); 182 struct dkwedge_info *dkw; 183 184 switch (cmd) { 185 case DIOCGWEDGEINFO: 186 dkw = (void *)data; 187 strlcpy(dkw->dkw_devname, device_xname(sc->sc_dev), 188 sizeof(dkw->dkw_devname)); 189 strlcpy(dkw->dkw_wname, "altmem", sizeof(dkw->dkw_wname)); 190 dkw->dkw_parent[0] = '\0'; 191 dkw->dkw_offset = 0; 192 dkw->dkw_size = sc->sc_size >> DEV_BSHIFT; 193 strcpy(dkw->dkw_ptype, DKW_PTYPE_UNUSED); 194 break; 195 default: 196 return ENOTTY; 197 } 198 return 0; 199 } 200
Indexes created Fri Sep 26 20:09:58 GMT 2025