FreeBSD/Linux Kernel Cross Reference
sys/geom/gate/g_gate.c
1 /*-
2 * Copyright (c) 2004-2006 Pawel Jakub Dawidek <pjd@FreeBSD.org>
3 * Copyright (c) 2009-2010 The FreeBSD Foundation
4 * All rights reserved.
5 *
6 * Portions of this software were developed by Pawel Jakub Dawidek
7 * under sponsorship from the FreeBSD Foundation.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28 * SUCH DAMAGE.
29 */
30
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD: releng/8.1/sys/geom/gate/g_gate.c 209487 2010-06-23 23:03:25Z pjd $");
33
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/bio.h>
37 #include <sys/conf.h>
38 #include <sys/kernel.h>
39 #include <sys/kthread.h>
40 #include <sys/fcntl.h>
41 #include <sys/linker.h>
42 #include <sys/lock.h>
43 #include <sys/malloc.h>
44 #include <sys/mutex.h>
45 #include <sys/proc.h>
46 #include <sys/limits.h>
47 #include <sys/queue.h>
48 #include <sys/sysctl.h>
49 #include <sys/signalvar.h>
50 #include <sys/time.h>
51 #include <machine/atomic.h>
52
53 #include <geom/geom.h>
54 #include <geom/gate/g_gate.h>
55
56 static MALLOC_DEFINE(M_GATE, "gg_data", "GEOM Gate Data");
57
58 SYSCTL_DECL(_kern_geom);
59 SYSCTL_NODE(_kern_geom, OID_AUTO, gate, CTLFLAG_RW, 0, "GEOM_GATE stuff");
60 static int g_gate_debug = 0;
61 TUNABLE_INT("kern.geom.gate.debug", &g_gate_debug);
62 SYSCTL_INT(_kern_geom_gate, OID_AUTO, debug, CTLFLAG_RW, &g_gate_debug, 0,
63 "Debug level");
64 static u_int g_gate_maxunits = 256;
65 TUNABLE_INT("kern.geom.gate.maxunits", &g_gate_maxunits);
66 SYSCTL_UINT(_kern_geom_gate, OID_AUTO, maxunits, CTLFLAG_RDTUN,
67 &g_gate_maxunits, 0, "Maximum number of ggate devices");
68
69 struct g_class g_gate_class = {
70 .name = G_GATE_CLASS_NAME,
71 .version = G_VERSION,
72 };
73
74 static struct cdev *status_dev;
75 static d_ioctl_t g_gate_ioctl;
76 static struct cdevsw g_gate_cdevsw = {
77 .d_version = D_VERSION,
78 .d_ioctl = g_gate_ioctl,
79 .d_name = G_GATE_CTL_NAME
80 };
81
82
83 static struct g_gate_softc **g_gate_units;
84 static u_int g_gate_nunits;
85 static struct mtx g_gate_units_lock;
86
87 static int
88 g_gate_destroy(struct g_gate_softc *sc, boolean_t force)
89 {
90 struct g_provider *pp;
91 struct g_geom *gp;
92 struct bio *bp;
93
94 g_topology_assert();
95 mtx_assert(&g_gate_units_lock, MA_OWNED);
96 pp = sc->sc_provider;
97 if (!force && (pp->acr != 0 || pp->acw != 0 || pp->ace != 0)) {
98 mtx_unlock(&g_gate_units_lock);
99 return (EBUSY);
100 }
101 mtx_unlock(&g_gate_units_lock);
102 mtx_lock(&sc->sc_queue_mtx);
103 if ((sc->sc_flags & G_GATE_FLAG_DESTROY) == 0)
104 sc->sc_flags |= G_GATE_FLAG_DESTROY;
105 wakeup(sc);
106 mtx_unlock(&sc->sc_queue_mtx);
107 gp = pp->geom;
108 pp->flags |= G_PF_WITHER;
109 g_orphan_provider(pp, ENXIO);
110 callout_drain(&sc->sc_callout);
111 mtx_lock(&sc->sc_queue_mtx);
112 while ((bp = bioq_first(&sc->sc_inqueue)) != NULL) {
113 bioq_remove(&sc->sc_inqueue, bp);
114 sc->sc_queue_count--;
115 G_GATE_LOGREQ(1, bp, "Request canceled.");
116 g_io_deliver(bp, ENXIO);
117 }
118 while ((bp = bioq_first(&sc->sc_outqueue)) != NULL) {
119 bioq_remove(&sc->sc_outqueue, bp);
120 sc->sc_queue_count--;
121 G_GATE_LOGREQ(1, bp, "Request canceled.");
122 g_io_deliver(bp, ENXIO);
123 }
124 mtx_unlock(&sc->sc_queue_mtx);
125 g_topology_unlock();
126 mtx_lock(&g_gate_units_lock);
127 /* One reference is ours. */
128 sc->sc_ref--;
129 while (sc->sc_ref > 0)
130 msleep(&sc->sc_ref, &g_gate_units_lock, 0, "gg:destroy", 0);
131 g_gate_units[sc->sc_unit] = NULL;
132 KASSERT(g_gate_nunits > 0, ("negative g_gate_nunits?"));
133 g_gate_nunits--;
134 mtx_unlock(&g_gate_units_lock);
135 mtx_destroy(&sc->sc_queue_mtx);
136 g_topology_lock();
137 G_GATE_DEBUG(0, "Device %s destroyed.", gp->name);
138 gp->softc = NULL;
139 g_wither_geom(gp, ENXIO);
140 sc->sc_provider = NULL;
141 free(sc, M_GATE);
142 return (0);
143 }
144
145 static int
146 g_gate_access(struct g_provider *pp, int dr, int dw, int de)
147 {
148 struct g_gate_softc *sc;
149
150 if (dr <= 0 && dw <= 0 && de <= 0)
151 return (0);
152 sc = pp->geom->softc;
153 if (sc == NULL || (sc->sc_flags & G_GATE_FLAG_DESTROY) != 0)
154 return (ENXIO);
155 /* XXX: Hack to allow read-only mounts. */
156 #if 0
157 if ((sc->sc_flags & G_GATE_FLAG_READONLY) != 0 && dw > 0)
158 return (EPERM);
159 #endif
160 if ((sc->sc_flags & G_GATE_FLAG_WRITEONLY) != 0 && dr > 0)
161 return (EPERM);
162 return (0);
163 }
164
165 static void
166 g_gate_start(struct bio *bp)
167 {
168 struct g_gate_softc *sc;
169
170 sc = bp->bio_to->geom->softc;
171 if (sc == NULL || (sc->sc_flags & G_GATE_FLAG_DESTROY) != 0) {
172 g_io_deliver(bp, ENXIO);
173 return;
174 }
175 G_GATE_LOGREQ(2, bp, "Request received.");
176 switch (bp->bio_cmd) {
177 case BIO_READ:
178 break;
179 case BIO_DELETE:
180 case BIO_WRITE:
181 /* XXX: Hack to allow read-only mounts. */
182 if ((sc->sc_flags & G_GATE_FLAG_READONLY) != 0) {
183 g_io_deliver(bp, EPERM);
184 return;
185 }
186 break;
187 case BIO_GETATTR:
188 default:
189 G_GATE_LOGREQ(2, bp, "Ignoring request.");
190 g_io_deliver(bp, EOPNOTSUPP);
191 return;
192 }
193
194 mtx_lock(&sc->sc_queue_mtx);
195 if (sc->sc_queue_count > sc->sc_queue_size) {
196 mtx_unlock(&sc->sc_queue_mtx);
197 G_GATE_LOGREQ(1, bp, "Queue full, request canceled.");
198 g_io_deliver(bp, ENOMEM);
199 return;
200 }
201
202 bp->bio_driver1 = (void *)sc->sc_seq;
203 sc->sc_seq++;
204 sc->sc_queue_count++;
205
206 bioq_insert_tail(&sc->sc_inqueue, bp);
207 wakeup(sc);
208
209 mtx_unlock(&sc->sc_queue_mtx);
210 }
211
212 static struct g_gate_softc *
213 g_gate_hold(int unit, const char *name)
214 {
215 struct g_gate_softc *sc = NULL;
216
217 mtx_lock(&g_gate_units_lock);
218 if (unit >= 0 && unit < g_gate_maxunits)
219 sc = g_gate_units[unit];
220 else if (unit == G_GATE_NAME_GIVEN) {
221 KASSERT(name != NULL, ("name is NULL"));
222 for (unit = 0; unit < g_gate_maxunits; unit++) {
223 if (g_gate_units[unit] == NULL)
224 continue;
225 if (strcmp(name,
226 g_gate_units[unit]->sc_provider->name) != 0) {
227 continue;
228 }
229 sc = g_gate_units[unit];
230 break;
231 }
232 }
233 if (sc != NULL)
234 sc->sc_ref++;
235 mtx_unlock(&g_gate_units_lock);
236 return (sc);
237 }
238
239 static void
240 g_gate_release(struct g_gate_softc *sc)
241 {
242
243 g_topology_assert_not();
244 mtx_lock(&g_gate_units_lock);
245 sc->sc_ref--;
246 KASSERT(sc->sc_ref >= 0, ("Negative sc_ref for %s.", sc->sc_name));
247 if (sc->sc_ref == 0 && (sc->sc_flags & G_GATE_FLAG_DESTROY) != 0)
248 wakeup(&sc->sc_ref);
249 mtx_unlock(&g_gate_units_lock);
250 }
251
252 static int
253 g_gate_getunit(int unit, int *errorp)
254 {
255
256 mtx_assert(&g_gate_units_lock, MA_OWNED);
257 if (unit >= 0) {
258 if (unit >= g_gate_maxunits)
259 *errorp = EINVAL;
260 else if (g_gate_units[unit] == NULL)
261 return (unit);
262 else
263 *errorp = EEXIST;
264 } else {
265 for (unit = 0; unit < g_gate_maxunits; unit++) {
266 if (g_gate_units[unit] == NULL)
267 return (unit);
268 }
269 *errorp = ENFILE;
270 }
271 return (-1);
272 }
273
274 static void
275 g_gate_guard(void *arg)
276 {
277 struct g_gate_softc *sc;
278 struct bintime curtime;
279 struct bio *bp, *bp2;
280
281 sc = arg;
282 binuptime(&curtime);
283 g_gate_hold(sc->sc_unit, NULL);
284 mtx_lock(&sc->sc_queue_mtx);
285 TAILQ_FOREACH_SAFE(bp, &sc->sc_inqueue.queue, bio_queue, bp2) {
286 if (curtime.sec - bp->bio_t0.sec < 5)
287 continue;
288 bioq_remove(&sc->sc_inqueue, bp);
289 sc->sc_queue_count--;
290 G_GATE_LOGREQ(1, bp, "Request timeout.");
291 g_io_deliver(bp, EIO);
292 }
293 TAILQ_FOREACH_SAFE(bp, &sc->sc_outqueue.queue, bio_queue, bp2) {
294 if (curtime.sec - bp->bio_t0.sec < 5)
295 continue;
296 bioq_remove(&sc->sc_outqueue, bp);
297 sc->sc_queue_count--;
298 G_GATE_LOGREQ(1, bp, "Request timeout.");
299 g_io_deliver(bp, EIO);
300 }
301 mtx_unlock(&sc->sc_queue_mtx);
302 if ((sc->sc_flags & G_GATE_FLAG_DESTROY) == 0) {
303 callout_reset(&sc->sc_callout, sc->sc_timeout * hz,
304 g_gate_guard, sc);
305 }
306 g_gate_release(sc);
307 }
308
309 static void
310 g_gate_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp,
311 struct g_consumer *cp, struct g_provider *pp)
312 {
313 struct g_gate_softc *sc;
314
315 sc = gp->softc;
316 if (sc == NULL || pp != NULL || cp != NULL)
317 return;
318 g_gate_hold(sc->sc_unit, NULL);
319 if ((sc->sc_flags & G_GATE_FLAG_READONLY) != 0) {
320 sbuf_printf(sb, "%s<access>%s</access>\n", indent, "read-only");
321 } else if ((sc->sc_flags & G_GATE_FLAG_WRITEONLY) != 0) {
322 sbuf_printf(sb, "%s<access>%s</access>\n", indent,
323 "write-only");
324 } else {
325 sbuf_printf(sb, "%s<access>%s</access>\n", indent,
326 "read-write");
327 }
328 sbuf_printf(sb, "%s<timeout>%u</timeout>\n", indent, sc->sc_timeout);
329 sbuf_printf(sb, "%s<info>%s</info>\n", indent, sc->sc_info);
330 sbuf_printf(sb, "%s<queue_count>%u</queue_count>\n", indent,
331 sc->sc_queue_count);
332 sbuf_printf(sb, "%s<queue_size>%u</queue_size>\n", indent,
333 sc->sc_queue_size);
334 sbuf_printf(sb, "%s<ref>%u</ref>\n", indent, sc->sc_ref);
335 sbuf_printf(sb, "%s<unit>%d</unit>\n", indent, sc->sc_unit);
336 g_topology_unlock();
337 g_gate_release(sc);
338 g_topology_lock();
339 }
340
341 static int
342 g_gate_create(struct g_gate_ctl_create *ggio)
343 {
344 struct g_gate_softc *sc;
345 struct g_geom *gp;
346 struct g_provider *pp;
347 char name[NAME_MAX];
348 int error = 0, unit;
349
350 if (ggio->gctl_mediasize == 0) {
351 G_GATE_DEBUG(1, "Invalid media size.");
352 return (EINVAL);
353 }
354 if (ggio->gctl_sectorsize > 0 && !powerof2(ggio->gctl_sectorsize)) {
355 G_GATE_DEBUG(1, "Invalid sector size.");
356 return (EINVAL);
357 }
358 if ((ggio->gctl_mediasize % ggio->gctl_sectorsize) != 0) {
359 G_GATE_DEBUG(1, "Invalid media size.");
360 return (EINVAL);
361 }
362 if ((ggio->gctl_flags & G_GATE_FLAG_READONLY) != 0 &&
363 (ggio->gctl_flags & G_GATE_FLAG_WRITEONLY) != 0) {
364 G_GATE_DEBUG(1, "Invalid flags.");
365 return (EINVAL);
366 }
367 if (ggio->gctl_unit != G_GATE_UNIT_AUTO &&
368 ggio->gctl_unit != G_GATE_NAME_GIVEN &&
369 ggio->gctl_unit < 0) {
370 G_GATE_DEBUG(1, "Invalid unit number.");
371 return (EINVAL);
372 }
373 if (ggio->gctl_unit == G_GATE_NAME_GIVEN &&
374 ggio->gctl_name[0] == '\0') {
375 G_GATE_DEBUG(1, "No device name.");
376 return (EINVAL);
377 }
378
379 sc = malloc(sizeof(*sc), M_GATE, M_WAITOK | M_ZERO);
380 sc->sc_flags = (ggio->gctl_flags & G_GATE_USERFLAGS);
381 strlcpy(sc->sc_info, ggio->gctl_info, sizeof(sc->sc_info));
382 sc->sc_seq = 1;
383 bioq_init(&sc->sc_inqueue);
384 bioq_init(&sc->sc_outqueue);
385 mtx_init(&sc->sc_queue_mtx, "gg:queue", NULL, MTX_DEF);
386 sc->sc_queue_count = 0;
387 sc->sc_queue_size = ggio->gctl_maxcount;
388 if (sc->sc_queue_size > G_GATE_MAX_QUEUE_SIZE)
389 sc->sc_queue_size = G_GATE_MAX_QUEUE_SIZE;
390 sc->sc_timeout = ggio->gctl_timeout;
391 callout_init(&sc->sc_callout, CALLOUT_MPSAFE);
392 mtx_lock(&g_gate_units_lock);
393 sc->sc_unit = g_gate_getunit(ggio->gctl_unit, &error);
394 if (sc->sc_unit < 0) {
395 mtx_unlock(&g_gate_units_lock);
396 mtx_destroy(&sc->sc_queue_mtx);
397 free(sc, M_GATE);
398 return (error);
399 }
400 if (ggio->gctl_unit == G_GATE_NAME_GIVEN)
401 snprintf(name, sizeof(name), "%s", ggio->gctl_name);
402 else {
403 snprintf(name, sizeof(name), "%s%d", G_GATE_PROVIDER_NAME,
404 sc->sc_unit);
405 }
406 /* Check for name collision. */
407 for (unit = 0; unit < g_gate_maxunits; unit++) {
408 if (g_gate_units[unit] == NULL)
409 continue;
410 if (strcmp(name, g_gate_units[unit]->sc_provider->name) != 0)
411 continue;
412 mtx_unlock(&g_gate_units_lock);
413 mtx_destroy(&sc->sc_queue_mtx);
414 free(sc, M_GATE);
415 return (EEXIST);
416 }
417 g_gate_units[sc->sc_unit] = sc;
418 g_gate_nunits++;
419 mtx_unlock(&g_gate_units_lock);
420
421 ggio->gctl_unit = sc->sc_unit;
422
423 g_topology_lock();
424 gp = g_new_geomf(&g_gate_class, "%s", name);
425 gp->start = g_gate_start;
426 gp->access = g_gate_access;
427 gp->dumpconf = g_gate_dumpconf;
428 gp->softc = sc;
429 pp = g_new_providerf(gp, "%s", name);
430 pp->mediasize = ggio->gctl_mediasize;
431 pp->sectorsize = ggio->gctl_sectorsize;
432 sc->sc_provider = pp;
433 g_error_provider(pp, 0);
434 g_topology_unlock();
435
436 if (sc->sc_timeout > 0) {
437 callout_reset(&sc->sc_callout, sc->sc_timeout * hz,
438 g_gate_guard, sc);
439 }
440 return (0);
441 }
442
443 #define G_GATE_CHECK_VERSION(ggio) do { \
444 if ((ggio)->gctl_version != G_GATE_VERSION) { \
445 printf("Version mismatch %d != %d.\n", \
446 ggio->gctl_version, G_GATE_VERSION); \
447 return (EINVAL); \
448 } \
449 } while (0)
450 static int
451 g_gate_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, struct thread *td)
452 {
453 struct g_gate_softc *sc;
454 struct bio *bp;
455 int error = 0;
456
457 G_GATE_DEBUG(4, "ioctl(%s, %lx, %p, %x, %p)", devtoname(dev), cmd, addr,
458 flags, td);
459
460 switch (cmd) {
461 case G_GATE_CMD_CREATE:
462 {
463 struct g_gate_ctl_create *ggio = (void *)addr;
464
465 G_GATE_CHECK_VERSION(ggio);
466 error = g_gate_create(ggio);
467 /*
468 * Reset TDP_GEOM flag.
469 * There are pending events for sure, because we just created
470 * new provider and other classes want to taste it, but we
471 * cannot answer on I/O requests until we're here.
472 */
473 td->td_pflags &= ~TDP_GEOM;
474 return (error);
475 }
476 case G_GATE_CMD_DESTROY:
477 {
478 struct g_gate_ctl_destroy *ggio = (void *)addr;
479
480 G_GATE_CHECK_VERSION(ggio);
481 sc = g_gate_hold(ggio->gctl_unit, ggio->gctl_name);
482 if (sc == NULL)
483 return (ENXIO);
484 g_topology_lock();
485 mtx_lock(&g_gate_units_lock);
486 error = g_gate_destroy(sc, ggio->gctl_force);
487 g_topology_unlock();
488 if (error != 0)
489 g_gate_release(sc);
490 return (error);
491 }
492 case G_GATE_CMD_CANCEL:
493 {
494 struct g_gate_ctl_cancel *ggio = (void *)addr;
495 struct bio *tbp, *lbp;
496
497 G_GATE_CHECK_VERSION(ggio);
498 sc = g_gate_hold(ggio->gctl_unit, ggio->gctl_name);
499 if (sc == NULL)
500 return (ENXIO);
501 lbp = NULL;
502 mtx_lock(&sc->sc_queue_mtx);
503 TAILQ_FOREACH_SAFE(bp, &sc->sc_outqueue.queue, bio_queue, tbp) {
504 if (ggio->gctl_seq == 0 ||
505 ggio->gctl_seq == (uintptr_t)bp->bio_driver1) {
506 G_GATE_LOGREQ(1, bp, "Request canceled.");
507 bioq_remove(&sc->sc_outqueue, bp);
508 /*
509 * Be sure to put requests back onto incoming
510 * queue in the proper order.
511 */
512 if (lbp == NULL)
513 bioq_insert_head(&sc->sc_inqueue, bp);
514 else {
515 TAILQ_INSERT_AFTER(&sc->sc_inqueue.queue,
516 lbp, bp, bio_queue);
517 }
518 lbp = bp;
519 /*
520 * If only one request was canceled, leave now.
521 */
522 if (ggio->gctl_seq != 0)
523 break;
524 }
525 }
526 if (ggio->gctl_unit == G_GATE_NAME_GIVEN)
527 ggio->gctl_unit = sc->sc_unit;
528 mtx_unlock(&sc->sc_queue_mtx);
529 g_gate_release(sc);
530 return (error);
531 }
532 case G_GATE_CMD_START:
533 {
534 struct g_gate_ctl_io *ggio = (void *)addr;
535
536 G_GATE_CHECK_VERSION(ggio);
537 sc = g_gate_hold(ggio->gctl_unit, NULL);
538 if (sc == NULL)
539 return (ENXIO);
540 error = 0;
541 for (;;) {
542 mtx_lock(&sc->sc_queue_mtx);
543 bp = bioq_first(&sc->sc_inqueue);
544 if (bp != NULL)
545 break;
546 if ((sc->sc_flags & G_GATE_FLAG_DESTROY) != 0) {
547 ggio->gctl_error = ECANCELED;
548 mtx_unlock(&sc->sc_queue_mtx);
549 goto start_end;
550 }
551 if (msleep(sc, &sc->sc_queue_mtx,
552 PPAUSE | PDROP | PCATCH, "ggwait", 0) != 0) {
553 ggio->gctl_error = ECANCELED;
554 goto start_end;
555 }
556 }
557 ggio->gctl_cmd = bp->bio_cmd;
558 if ((bp->bio_cmd == BIO_DELETE || bp->bio_cmd == BIO_WRITE) &&
559 bp->bio_length > ggio->gctl_length) {
560 mtx_unlock(&sc->sc_queue_mtx);
561 ggio->gctl_length = bp->bio_length;
562 ggio->gctl_error = ENOMEM;
563 goto start_end;
564 }
565 bioq_remove(&sc->sc_inqueue, bp);
566 bioq_insert_tail(&sc->sc_outqueue, bp);
567 mtx_unlock(&sc->sc_queue_mtx);
568
569 ggio->gctl_seq = (uintptr_t)bp->bio_driver1;
570 ggio->gctl_offset = bp->bio_offset;
571 ggio->gctl_length = bp->bio_length;
572
573 switch (bp->bio_cmd) {
574 case BIO_READ:
575 case BIO_DELETE:
576 break;
577 case BIO_WRITE:
578 error = copyout(bp->bio_data, ggio->gctl_data,
579 bp->bio_length);
580 if (error != 0) {
581 mtx_lock(&sc->sc_queue_mtx);
582 bioq_remove(&sc->sc_outqueue, bp);
583 bioq_insert_head(&sc->sc_inqueue, bp);
584 mtx_unlock(&sc->sc_queue_mtx);
585 goto start_end;
586 }
587 break;
588 }
589 start_end:
590 g_gate_release(sc);
591 return (error);
592 }
593 case G_GATE_CMD_DONE:
594 {
595 struct g_gate_ctl_io *ggio = (void *)addr;
596
597 G_GATE_CHECK_VERSION(ggio);
598 sc = g_gate_hold(ggio->gctl_unit, NULL);
599 if (sc == NULL)
600 return (ENOENT);
601 error = 0;
602 mtx_lock(&sc->sc_queue_mtx);
603 TAILQ_FOREACH(bp, &sc->sc_outqueue.queue, bio_queue) {
604 if (ggio->gctl_seq == (uintptr_t)bp->bio_driver1)
605 break;
606 }
607 if (bp != NULL) {
608 bioq_remove(&sc->sc_outqueue, bp);
609 sc->sc_queue_count--;
610 }
611 mtx_unlock(&sc->sc_queue_mtx);
612 if (bp == NULL) {
613 /*
614 * Request was probably canceled.
615 */
616 goto done_end;
617 }
618 if (ggio->gctl_error == EAGAIN) {
619 bp->bio_error = 0;
620 G_GATE_LOGREQ(1, bp, "Request desisted.");
621 mtx_lock(&sc->sc_queue_mtx);
622 sc->sc_queue_count++;
623 bioq_insert_head(&sc->sc_inqueue, bp);
624 wakeup(sc);
625 mtx_unlock(&sc->sc_queue_mtx);
626 } else {
627 bp->bio_error = ggio->gctl_error;
628 if (bp->bio_error == 0) {
629 bp->bio_completed = bp->bio_length;
630 switch (bp->bio_cmd) {
631 case BIO_READ:
632 error = copyin(ggio->gctl_data,
633 bp->bio_data, bp->bio_length);
634 if (error != 0)
635 bp->bio_error = error;
636 break;
637 case BIO_DELETE:
638 case BIO_WRITE:
639 break;
640 }
641 }
642 G_GATE_LOGREQ(2, bp, "Request done.");
643 g_io_deliver(bp, bp->bio_error);
644 }
645 done_end:
646 g_gate_release(sc);
647 return (error);
648 }
649 }
650 return (ENOIOCTL);
651 }
652
653 static void
654 g_gate_device(void)
655 {
656
657 status_dev = make_dev(&g_gate_cdevsw, 0x0, UID_ROOT, GID_WHEEL, 0600,
658 G_GATE_CTL_NAME);
659 }
660
661 static int
662 g_gate_modevent(module_t mod, int type, void *data)
663 {
664 int error = 0;
665
666 switch (type) {
667 case MOD_LOAD:
668 mtx_init(&g_gate_units_lock, "gg_units_lock", NULL, MTX_DEF);
669 g_gate_units = malloc(g_gate_maxunits * sizeof(g_gate_units[0]),
670 M_GATE, M_WAITOK | M_ZERO);
671 g_gate_nunits = 0;
672 g_gate_device();
673 break;
674 case MOD_UNLOAD:
675 mtx_lock(&g_gate_units_lock);
676 if (g_gate_nunits > 0) {
677 mtx_unlock(&g_gate_units_lock);
678 error = EBUSY;
679 break;
680 }
681 mtx_unlock(&g_gate_units_lock);
682 mtx_destroy(&g_gate_units_lock);
683 if (status_dev != 0)
684 destroy_dev(status_dev);
685 free(g_gate_units, M_GATE);
686 break;
687 default:
688 return (EOPNOTSUPP);
689 break;
690 }
691
692 return (error);
693 }
694 static moduledata_t g_gate_module = {
695 G_GATE_MOD_NAME,
696 g_gate_modevent,
697 NULL
698 };
699 DECLARE_MODULE(geom_gate, g_gate_module, SI_SUB_DRIVERS, SI_ORDER_MIDDLE);
700 DECLARE_GEOM_CLASS(g_gate_class, g_gate);
Cache object: 9e98845a5a9b871549dde6f4af8a002c
|