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