xref: /freebsd/sys/geom/geom_disk.c (revision 42fbdde4133c7bcb834f689b63f6e6100a4a28b5)
1dd84a43cSPoul-Henning Kamp /*-
2dd84a43cSPoul-Henning Kamp  * Copyright (c) 2002 Poul-Henning Kamp
3dd84a43cSPoul-Henning Kamp  * Copyright (c) 2002 Networks Associates Technology, Inc.
4dd84a43cSPoul-Henning Kamp  * All rights reserved.
5dd84a43cSPoul-Henning Kamp  *
6dd84a43cSPoul-Henning Kamp  * This software was developed for the FreeBSD Project by Poul-Henning Kamp
7dd84a43cSPoul-Henning Kamp  * and NAI Labs, the Security Research Division of Network Associates, Inc.
8dd84a43cSPoul-Henning Kamp  * under DARPA/SPAWAR contract N66001-01-C-8035 ("CBOSS"), as part of the
9dd84a43cSPoul-Henning Kamp  * DARPA CHATS research program.
10dd84a43cSPoul-Henning Kamp  *
11dd84a43cSPoul-Henning Kamp  * Redistribution and use in source and binary forms, with or without
12dd84a43cSPoul-Henning Kamp  * modification, are permitted provided that the following conditions
13dd84a43cSPoul-Henning Kamp  * are met:
14dd84a43cSPoul-Henning Kamp  * 1. Redistributions of source code must retain the above copyright
15dd84a43cSPoul-Henning Kamp  *    notice, this list of conditions and the following disclaimer.
16dd84a43cSPoul-Henning Kamp  * 2. Redistributions in binary form must reproduce the above copyright
17dd84a43cSPoul-Henning Kamp  *    notice, this list of conditions and the following disclaimer in the
18dd84a43cSPoul-Henning Kamp  *    documentation and/or other materials provided with the distribution.
19dd84a43cSPoul-Henning Kamp  * 3. The names of the authors may not be used to endorse or promote
20dd84a43cSPoul-Henning Kamp  *    products derived from this software without specific prior written
21dd84a43cSPoul-Henning Kamp  *    permission.
22dd84a43cSPoul-Henning Kamp  *
23dd84a43cSPoul-Henning Kamp  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
24dd84a43cSPoul-Henning Kamp  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25dd84a43cSPoul-Henning Kamp  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26dd84a43cSPoul-Henning Kamp  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
27dd84a43cSPoul-Henning Kamp  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28dd84a43cSPoul-Henning Kamp  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29dd84a43cSPoul-Henning Kamp  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30dd84a43cSPoul-Henning Kamp  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31dd84a43cSPoul-Henning Kamp  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32dd84a43cSPoul-Henning Kamp  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33dd84a43cSPoul-Henning Kamp  * SUCH DAMAGE.
34dd84a43cSPoul-Henning Kamp  */
35dd84a43cSPoul-Henning Kamp 
3650b1faefSDavid E. O'Brien #include <sys/cdefs.h>
3750b1faefSDavid E. O'Brien __FBSDID("$FreeBSD$");
3850b1faefSDavid E. O'Brien 
393bd65612SPoul-Henning Kamp #include "opt_geom.h"
403bd65612SPoul-Henning Kamp 
41dd84a43cSPoul-Henning Kamp #include <sys/param.h>
42dd84a43cSPoul-Henning Kamp #include <sys/systm.h>
43dd84a43cSPoul-Henning Kamp #include <sys/kernel.h>
44dd84a43cSPoul-Henning Kamp #include <sys/sysctl.h>
45dd84a43cSPoul-Henning Kamp #include <sys/bio.h>
46e93f5e4dSPawel Jakub Dawidek #include <sys/ctype.h>
4731a1093fSPoul-Henning Kamp #include <sys/fcntl.h>
48dd84a43cSPoul-Henning Kamp #include <sys/malloc.h>
495d807a0eSAndrey V. Elsukov #include <sys/sbuf.h>
5060794e04SPoul-Henning Kamp #include <sys/devicestat.h>
51dd84a43cSPoul-Henning Kamp #include <machine/md_var.h>
52dd84a43cSPoul-Henning Kamp 
53dd84a43cSPoul-Henning Kamp #include <sys/lock.h>
54dd84a43cSPoul-Henning Kamp #include <sys/mutex.h>
55dd84a43cSPoul-Henning Kamp #include <geom/geom.h>
564752f757SPoul-Henning Kamp #include <geom/geom_disk.h>
577da1ebfdSPoul-Henning Kamp #include <geom/geom_int.h>
58dd84a43cSPoul-Henning Kamp 
59c6d4ed3aSAlexander Motin #include <dev/led/led.h>
60c6d4ed3aSAlexander Motin 
61a9934668SKenneth D. Merry #include <machine/bus.h>
62a9934668SKenneth D. Merry 
63c6d4ed3aSAlexander Motin struct g_disk_softc {
6430ba7471SAlexander Motin 	struct mtx		 done_mtx;
65c6d4ed3aSAlexander Motin 	struct disk		*dp;
66c6d4ed3aSAlexander Motin 	struct sysctl_ctx_list	sysctl_ctx;
67c6d4ed3aSAlexander Motin 	struct sysctl_oid	*sysctl_tree;
68c6d4ed3aSAlexander Motin 	char			led[64];
69c6d4ed3aSAlexander Motin 	uint32_t		state;
7040ea77a0SAlexander Motin 	struct mtx		 start_mtx;
71c6d4ed3aSAlexander Motin };
72c6d4ed3aSAlexander Motin 
73dd84a43cSPoul-Henning Kamp static g_access_t g_disk_access;
74650ee351SPoul-Henning Kamp static g_start_t g_disk_start;
75650ee351SPoul-Henning Kamp static g_ioctl_t g_disk_ioctl;
76650ee351SPoul-Henning Kamp static g_dumpconf_t g_disk_dumpconf;
77c3fb2891SKenneth D. Merry static g_provgone_t g_disk_providergone;
78dd84a43cSPoul-Henning Kamp 
7907e95ed6SPoul-Henning Kamp static struct g_class g_disk_class = {
80252c094eSIvan Voras 	.name = G_DISK_CLASS_NAME,
815721c9c7SPoul-Henning Kamp 	.version = G_VERSION,
82650ee351SPoul-Henning Kamp 	.start = g_disk_start,
83650ee351SPoul-Henning Kamp 	.access = g_disk_access,
84650ee351SPoul-Henning Kamp 	.ioctl = g_disk_ioctl,
85c3fb2891SKenneth D. Merry 	.providergone = g_disk_providergone,
86650ee351SPoul-Henning Kamp 	.dumpconf = g_disk_dumpconf,
87dd84a43cSPoul-Henning Kamp };
88dd84a43cSPoul-Henning Kamp 
89c6d4ed3aSAlexander Motin SYSCTL_DECL(_kern_geom);
906472ac3dSEd Schouten static SYSCTL_NODE(_kern_geom, OID_AUTO, disk, CTLFLAG_RW, 0,
916472ac3dSEd Schouten     "GEOM_DISK stuff");
92c6d4ed3aSAlexander Motin 
936c87f8d5SPoul-Henning Kamp DECLARE_GEOM_CLASS(g_disk_class, g_disk);
948523987bSPoul-Henning Kamp 
95dd84a43cSPoul-Henning Kamp static int
96dd84a43cSPoul-Henning Kamp g_disk_access(struct g_provider *pp, int r, int w, int e)
97dd84a43cSPoul-Henning Kamp {
98dd84a43cSPoul-Henning Kamp 	struct disk *dp;
99c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
100dd84a43cSPoul-Henning Kamp 	int error;
101dd84a43cSPoul-Henning Kamp 
102dd84a43cSPoul-Henning Kamp 	g_trace(G_T_ACCESS, "g_disk_access(%s, %d, %d, %d)",
103dd84a43cSPoul-Henning Kamp 	    pp->name, r, w, e);
104dd84a43cSPoul-Henning Kamp 	g_topology_assert();
10530ba7471SAlexander Motin 	sc = pp->private;
106c6d4ed3aSAlexander Motin 	if (sc == NULL || (dp = sc->dp) == NULL || dp->d_destroyed) {
10712047230SPawel Jakub Dawidek 		/*
10812047230SPawel Jakub Dawidek 		 * Allow decreasing access count even if disk is not
10912047230SPawel Jakub Dawidek 		 * avaliable anymore.
11012047230SPawel Jakub Dawidek 		 */
11112047230SPawel Jakub Dawidek 		if (r <= 0 && w <= 0 && e <= 0)
11212047230SPawel Jakub Dawidek 			return (0);
11312047230SPawel Jakub Dawidek 		return (ENXIO);
11412047230SPawel Jakub Dawidek 	}
115dd84a43cSPoul-Henning Kamp 	r += pp->acr;
116dd84a43cSPoul-Henning Kamp 	w += pp->acw;
117dd84a43cSPoul-Henning Kamp 	e += pp->ace;
11831a1093fSPoul-Henning Kamp 	error = 0;
119dd84a43cSPoul-Henning Kamp 	if ((pp->acr + pp->acw + pp->ace) == 0 && (r + w + e) > 0) {
12098bbd7aaSPoul-Henning Kamp 		if (dp->d_open != NULL) {
12151dd8980SPoul-Henning Kamp 			error = dp->d_open(dp);
12255fe33a3SNick Hibma 			if (bootverbose && error != 0)
12331a1093fSPoul-Henning Kamp 				printf("Opened disk %s -> %d\n",
12431a1093fSPoul-Henning Kamp 				    pp->name, error);
125c145d600SAlexander Motin 			if (error != 0)
126c145d600SAlexander Motin 				return (error);
12731a1093fSPoul-Henning Kamp 		}
1283f12caa1SPoul-Henning Kamp 		pp->mediasize = dp->d_mediasize;
1293f12caa1SPoul-Henning Kamp 		pp->sectorsize = dp->d_sectorsize;
13099af707cSPoul-Henning Kamp 		if (dp->d_maxsize == 0) {
13199af707cSPoul-Henning Kamp 			printf("WARNING: Disk drive %s%d has no d_maxsize\n",
13299af707cSPoul-Henning Kamp 			    dp->d_name, dp->d_unit);
13399af707cSPoul-Henning Kamp 			dp->d_maxsize = DFLTPHYS;
13499af707cSPoul-Henning Kamp 		}
1358383a92eSSteven Hartland 		if (dp->d_delmaxsize == 0) {
1368383a92eSSteven Hartland 			if (bootverbose && dp->d_flags & DISKFLAG_CANDELETE) {
1378383a92eSSteven Hartland 				printf("WARNING: Disk drive %s%d has no "
1388383a92eSSteven Hartland 				    "d_delmaxsize\n", dp->d_name, dp->d_unit);
1399fe9ba5bSSteven Hartland 			}
1408383a92eSSteven Hartland 			dp->d_delmaxsize = dp->d_maxsize;
1419fe9ba5bSSteven Hartland 		}
1429fe9ba5bSSteven Hartland 		pp->stripeoffset = dp->d_stripeoffset;
1439fe9ba5bSSteven Hartland 		pp->stripesize = dp->d_stripesize;
1449fe9ba5bSSteven Hartland 		dp->d_flags |= DISKFLAG_OPEN;
145dd84a43cSPoul-Henning Kamp 	} else if ((pp->acr + pp->acw + pp->ace) > 0 && (r + w + e) == 0) {
14698bbd7aaSPoul-Henning Kamp 		if (dp->d_close != NULL) {
14751dd8980SPoul-Henning Kamp 			error = dp->d_close(dp);
148dd84a43cSPoul-Henning Kamp 			if (error != 0)
14931a1093fSPoul-Henning Kamp 				printf("Closed disk %s -> %d\n",
15031a1093fSPoul-Henning Kamp 				    pp->name, error);
15131a1093fSPoul-Henning Kamp 		}
152c6d4ed3aSAlexander Motin 		sc->state = G_STATE_ACTIVE;
153c6d4ed3aSAlexander Motin 		if (sc->led[0] != 0)
154c6d4ed3aSAlexander Motin 			led_set(sc->led, "0");
15531a1093fSPoul-Henning Kamp 		dp->d_flags &= ~DISKFLAG_OPEN;
156dd84a43cSPoul-Henning Kamp 	}
157dd84a43cSPoul-Henning Kamp 	return (error);
158dd84a43cSPoul-Henning Kamp }
159dd84a43cSPoul-Henning Kamp 
160dd84a43cSPoul-Henning Kamp static void
16195c24b31SPoul-Henning Kamp g_disk_kerneldump(struct bio *bp, struct disk *dp)
16295c24b31SPoul-Henning Kamp {
16395c24b31SPoul-Henning Kamp 	struct g_kerneldump *gkd;
1648be2bc5cSPoul-Henning Kamp 	struct g_geom *gp;
16595c24b31SPoul-Henning Kamp 
16695c24b31SPoul-Henning Kamp 	gkd = (struct g_kerneldump*)bp->bio_data;
1678be2bc5cSPoul-Henning Kamp 	gp = bp->bio_to->geom;
1681e4b22b4SBryan Drewery 	g_trace(G_T_TOPOLOGY, "g_disk_kerneldump(%s, %jd, %jd)",
1698be2bc5cSPoul-Henning Kamp 		gp->name, (intmax_t)gkd->offset, (intmax_t)gkd->length);
1705774ceadSPoul-Henning Kamp 	if (dp->d_dump == NULL) {
1715774ceadSPoul-Henning Kamp 		g_io_deliver(bp, ENODEV);
1725774ceadSPoul-Henning Kamp 		return;
1735774ceadSPoul-Henning Kamp 	}
17406f4c96dSAlexander Motin 	gkd->di.dumper = dp->d_dump;
17506f4c96dSAlexander Motin 	gkd->di.priv = dp;
17606f4c96dSAlexander Motin 	gkd->di.blocksize = dp->d_sectorsize;
17706f4c96dSAlexander Motin 	gkd->di.maxiosize = dp->d_maxsize;
17806f4c96dSAlexander Motin 	gkd->di.mediaoffset = gkd->offset;
1793ad9f7c2SPoul-Henning Kamp 	if ((gkd->offset + gkd->length) > dp->d_mediasize)
1803ad9f7c2SPoul-Henning Kamp 		gkd->length = dp->d_mediasize - gkd->offset;
18106f4c96dSAlexander Motin 	gkd->di.mediasize = gkd->length;
18206f4c96dSAlexander Motin 	g_io_deliver(bp, 0);
18395c24b31SPoul-Henning Kamp }
18495c24b31SPoul-Henning Kamp 
18595c24b31SPoul-Henning Kamp static void
186c6d4ed3aSAlexander Motin g_disk_setstate(struct bio *bp, struct g_disk_softc *sc)
187c6d4ed3aSAlexander Motin {
188c6d4ed3aSAlexander Motin 	const char *cmd;
189c6d4ed3aSAlexander Motin 
190c6d4ed3aSAlexander Motin 	memcpy(&sc->state, bp->bio_data, sizeof(sc->state));
191c6d4ed3aSAlexander Motin 	if (sc->led[0] != 0) {
192c6d4ed3aSAlexander Motin 		switch (sc->state) {
193c6d4ed3aSAlexander Motin 		case G_STATE_FAILED:
194c6d4ed3aSAlexander Motin 			cmd = "1";
195c6d4ed3aSAlexander Motin 			break;
196c6d4ed3aSAlexander Motin 		case G_STATE_REBUILD:
197c6d4ed3aSAlexander Motin 			cmd = "f5";
198c6d4ed3aSAlexander Motin 			break;
199c6d4ed3aSAlexander Motin 		case G_STATE_RESYNC:
200c6d4ed3aSAlexander Motin 			cmd = "f1";
201c6d4ed3aSAlexander Motin 			break;
202c6d4ed3aSAlexander Motin 		default:
203c6d4ed3aSAlexander Motin 			cmd = "0";
204c6d4ed3aSAlexander Motin 			break;
205c6d4ed3aSAlexander Motin 		}
206c6d4ed3aSAlexander Motin 		led_set(sc->led, cmd);
207c6d4ed3aSAlexander Motin 	}
208c6d4ed3aSAlexander Motin 	g_io_deliver(bp, 0);
209c6d4ed3aSAlexander Motin }
210c6d4ed3aSAlexander Motin 
211c6d4ed3aSAlexander Motin static void
212dd84a43cSPoul-Henning Kamp g_disk_done(struct bio *bp)
213dd84a43cSPoul-Henning Kamp {
214e431d66cSAlexander Motin 	struct bintime now;
21560794e04SPoul-Henning Kamp 	struct bio *bp2;
216c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
217dd84a43cSPoul-Henning Kamp 
21815c672a3SPoul-Henning Kamp 	/* See "notes" for why we need a mutex here */
21915c672a3SPoul-Henning Kamp 	/* XXX: will witness accept a mix of Giant/unGiant drivers here ? */
22060794e04SPoul-Henning Kamp 	bp2 = bp->bio_parent;
22130ba7471SAlexander Motin 	sc = bp2->bio_to->private;
22230ba7471SAlexander Motin 	bp->bio_completed = bp->bio_length - bp->bio_resid;
223e431d66cSAlexander Motin 	binuptime(&now);
22430ba7471SAlexander Motin 	mtx_lock(&sc->done_mtx);
22560794e04SPoul-Henning Kamp 	if (bp2->bio_error == 0)
22660794e04SPoul-Henning Kamp 		bp2->bio_error = bp->bio_error;
22760794e04SPoul-Henning Kamp 	bp2->bio_completed += bp->bio_completed;
228413037c8SAlexander Motin 	if ((bp->bio_cmd & (BIO_READ|BIO_WRITE|BIO_DELETE|BIO_FLUSH)) != 0)
229e431d66cSAlexander Motin 		devstat_end_transaction_bio_bt(sc->dp->d_devstat, bp, &now);
23060794e04SPoul-Henning Kamp 	bp2->bio_inbed++;
23160794e04SPoul-Henning Kamp 	if (bp2->bio_children == bp2->bio_inbed) {
2320fd2511aSAlexander Motin 		mtx_unlock(&sc->done_mtx);
23381876757SPoul-Henning Kamp 		bp2->bio_resid = bp2->bio_bcount - bp2->bio_completed;
23460794e04SPoul-Henning Kamp 		g_io_deliver(bp2, bp2->bio_error);
2350fd2511aSAlexander Motin 	} else
23630ba7471SAlexander Motin 		mtx_unlock(&sc->done_mtx);
2370fd2511aSAlexander Motin 	g_destroy_bio(bp);
238dd84a43cSPoul-Henning Kamp }
239dd84a43cSPoul-Henning Kamp 
240497c3347SPoul-Henning Kamp static int
2412221dbebSPoul-Henning Kamp g_disk_ioctl(struct g_provider *pp, u_long cmd, void * data, int fflag, struct thread *td)
242497c3347SPoul-Henning Kamp {
243497c3347SPoul-Henning Kamp 	struct disk *dp;
244c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
245497c3347SPoul-Henning Kamp 	int error;
246497c3347SPoul-Henning Kamp 
24730ba7471SAlexander Motin 	sc = pp->private;
248c6d4ed3aSAlexander Motin 	dp = sc->dp;
249497c3347SPoul-Henning Kamp 
250497c3347SPoul-Henning Kamp 	if (dp->d_ioctl == NULL)
251497c3347SPoul-Henning Kamp 		return (ENOIOCTL);
2522221dbebSPoul-Henning Kamp 	error = dp->d_ioctl(dp, cmd, data, fflag, td);
253497c3347SPoul-Henning Kamp 	return (error);
254497c3347SPoul-Henning Kamp }
255497c3347SPoul-Henning Kamp 
256*42fbdde4SKenneth D. Merry static off_t
257*42fbdde4SKenneth D. Merry g_disk_maxsize(struct disk *dp, struct bio *bp)
258a9934668SKenneth D. Merry {
259*42fbdde4SKenneth D. Merry 	if (bp->bio_cmd == BIO_DELETE)
260*42fbdde4SKenneth D. Merry 		return (dp->d_delmaxsize);
261*42fbdde4SKenneth D. Merry 	return (dp->d_maxsize);
262*42fbdde4SKenneth D. Merry }
263*42fbdde4SKenneth D. Merry 
264*42fbdde4SKenneth D. Merry static int
265*42fbdde4SKenneth D. Merry g_disk_maxsegs(struct disk *dp, struct bio *bp)
266*42fbdde4SKenneth D. Merry {
267*42fbdde4SKenneth D. Merry 	return ((g_disk_maxsize(dp, bp) / PAGE_SIZE) + 1);
268a9934668SKenneth D. Merry }
269a9934668SKenneth D. Merry 
270a9934668SKenneth D. Merry static void
271a9934668SKenneth D. Merry g_disk_advance(struct disk *dp, struct bio *bp, off_t off)
272a9934668SKenneth D. Merry {
273a9934668SKenneth D. Merry 
274a9934668SKenneth D. Merry 	bp->bio_offset += off;
275a9934668SKenneth D. Merry 	bp->bio_length -= off;
276a9934668SKenneth D. Merry 
277a9934668SKenneth D. Merry 	if ((bp->bio_flags & BIO_VLIST) != 0) {
278a9934668SKenneth D. Merry 		bus_dma_segment_t *seg, *end;
279a9934668SKenneth D. Merry 
280a9934668SKenneth D. Merry 		seg = (bus_dma_segment_t *)bp->bio_data;
281a9934668SKenneth D. Merry 		end = (bus_dma_segment_t *)bp->bio_data + bp->bio_ma_n;
282a9934668SKenneth D. Merry 		off += bp->bio_ma_offset;
283a9934668SKenneth D. Merry 		while (off >= seg->ds_len) {
284a9934668SKenneth D. Merry 			KASSERT((seg != end),
285a9934668SKenneth D. Merry 			    ("vlist request runs off the end"));
286a9934668SKenneth D. Merry 			off -= seg->ds_len;
287a9934668SKenneth D. Merry 			seg++;
288a9934668SKenneth D. Merry 		}
289a9934668SKenneth D. Merry 		bp->bio_ma_offset = off;
290a9934668SKenneth D. Merry 		bp->bio_ma_n = end - seg;
291a9934668SKenneth D. Merry 		bp->bio_data = (void *)seg;
292a9934668SKenneth D. Merry 	} else if ((bp->bio_flags & BIO_UNMAPPED) != 0) {
293a9934668SKenneth D. Merry 		bp->bio_ma += off / PAGE_SIZE;
294a9934668SKenneth D. Merry 		bp->bio_ma_offset += off;
295a9934668SKenneth D. Merry 		bp->bio_ma_offset %= PAGE_SIZE;
296a9934668SKenneth D. Merry 		bp->bio_ma_n -= off / PAGE_SIZE;
297a9934668SKenneth D. Merry 	} else {
298a9934668SKenneth D. Merry 		bp->bio_data += off;
299a9934668SKenneth D. Merry 	}
300a9934668SKenneth D. Merry }
301a9934668SKenneth D. Merry 
302a9934668SKenneth D. Merry static void
303a9934668SKenneth D. Merry g_disk_seg_limit(bus_dma_segment_t *seg, off_t *poffset,
304a9934668SKenneth D. Merry     off_t *plength, int *ppages)
305a9934668SKenneth D. Merry {
306a9934668SKenneth D. Merry 	uintptr_t seg_page_base;
307a9934668SKenneth D. Merry 	uintptr_t seg_page_end;
308a9934668SKenneth D. Merry 	off_t offset;
309a9934668SKenneth D. Merry 	off_t length;
310a9934668SKenneth D. Merry 	int seg_pages;
311a9934668SKenneth D. Merry 
312a9934668SKenneth D. Merry 	offset = *poffset;
313a9934668SKenneth D. Merry 	length = *plength;
314a9934668SKenneth D. Merry 
315a9934668SKenneth D. Merry 	if (length > seg->ds_len - offset)
316a9934668SKenneth D. Merry 		length = seg->ds_len - offset;
317a9934668SKenneth D. Merry 
318a9934668SKenneth D. Merry 	seg_page_base = trunc_page(seg->ds_addr + offset);
319a9934668SKenneth D. Merry 	seg_page_end  = round_page(seg->ds_addr + offset + length);
320a9934668SKenneth D. Merry 	seg_pages = (seg_page_end - seg_page_base) >> PAGE_SHIFT;
321a9934668SKenneth D. Merry 
322a9934668SKenneth D. Merry 	if (seg_pages > *ppages) {
323a9934668SKenneth D. Merry 		seg_pages = *ppages;
324a9934668SKenneth D. Merry 		length = (seg_page_base + (seg_pages << PAGE_SHIFT)) -
325a9934668SKenneth D. Merry 		    (seg->ds_addr + offset);
326a9934668SKenneth D. Merry 	}
327a9934668SKenneth D. Merry 
328a9934668SKenneth D. Merry 	*poffset = 0;
329a9934668SKenneth D. Merry 	*plength -= length;
330a9934668SKenneth D. Merry 	*ppages -= seg_pages;
331a9934668SKenneth D. Merry }
332a9934668SKenneth D. Merry 
333a9934668SKenneth D. Merry static off_t
334a9934668SKenneth D. Merry g_disk_vlist_limit(struct disk *dp, struct bio *bp, bus_dma_segment_t **pendseg)
335a9934668SKenneth D. Merry {
336a9934668SKenneth D. Merry 	bus_dma_segment_t *seg, *end;
337a9934668SKenneth D. Merry 	off_t residual;
338a9934668SKenneth D. Merry 	off_t offset;
339a9934668SKenneth D. Merry 	int pages;
340a9934668SKenneth D. Merry 
341a9934668SKenneth D. Merry 	seg = (bus_dma_segment_t *)bp->bio_data;
342a9934668SKenneth D. Merry 	end = (bus_dma_segment_t *)bp->bio_data + bp->bio_ma_n;
343a9934668SKenneth D. Merry 	residual = bp->bio_length;
344a9934668SKenneth D. Merry 	offset = bp->bio_ma_offset;
345*42fbdde4SKenneth D. Merry 	pages = g_disk_maxsegs(dp, bp);
346a9934668SKenneth D. Merry 	while (residual != 0 && pages != 0) {
347a9934668SKenneth D. Merry 		KASSERT((seg != end),
348a9934668SKenneth D. Merry 		    ("vlist limit runs off the end"));
349a9934668SKenneth D. Merry 		g_disk_seg_limit(seg, &offset, &residual, &pages);
350a9934668SKenneth D. Merry 		seg++;
351a9934668SKenneth D. Merry 	}
352a9934668SKenneth D. Merry 	if (pendseg != NULL)
353a9934668SKenneth D. Merry 		*pendseg = seg;
354a9934668SKenneth D. Merry 	return (residual);
355a9934668SKenneth D. Merry }
356a9934668SKenneth D. Merry 
357a9934668SKenneth D. Merry static bool
358a9934668SKenneth D. Merry g_disk_limit(struct disk *dp, struct bio *bp)
359a9934668SKenneth D. Merry {
360a9934668SKenneth D. Merry 	bool limited = false;
361*42fbdde4SKenneth D. Merry 	off_t maxsz = g_disk_maxsize(dp, bp);
362a9934668SKenneth D. Merry 
363a9934668SKenneth D. Merry 	/*
364a9934668SKenneth D. Merry 	 * XXX: If we have a stripesize we should really use it here.
365a9934668SKenneth D. Merry 	 *      Care should be taken in the delete case if this is done
366a9934668SKenneth D. Merry 	 *      as deletes can be very sensitive to size given how they
367a9934668SKenneth D. Merry 	 *      are processed.
368a9934668SKenneth D. Merry 	 */
369*42fbdde4SKenneth D. Merry 	if (bp->bio_length > maxsz) {
370*42fbdde4SKenneth D. Merry 		bp->bio_length = maxsz;
371a9934668SKenneth D. Merry 		limited = true;
372a9934668SKenneth D. Merry 	}
373a9934668SKenneth D. Merry 
374a9934668SKenneth D. Merry 	if ((bp->bio_flags & BIO_VLIST) != 0) {
375a9934668SKenneth D. Merry 		bus_dma_segment_t *firstseg, *endseg;
376a9934668SKenneth D. Merry 		off_t residual;
377a9934668SKenneth D. Merry 
378a9934668SKenneth D. Merry 		firstseg = (bus_dma_segment_t*)bp->bio_data;
379a9934668SKenneth D. Merry 		residual = g_disk_vlist_limit(dp, bp, &endseg);
380a9934668SKenneth D. Merry 		if (residual != 0) {
381a9934668SKenneth D. Merry 			bp->bio_ma_n = endseg - firstseg;
382a9934668SKenneth D. Merry 			bp->bio_length -= residual;
383a9934668SKenneth D. Merry 			limited = true;
384a9934668SKenneth D. Merry 		}
385a9934668SKenneth D. Merry 	} else if ((bp->bio_flags & BIO_UNMAPPED) != 0) {
386a9934668SKenneth D. Merry 		bp->bio_ma_n =
387a9934668SKenneth D. Merry 		    howmany(bp->bio_ma_offset + bp->bio_length, PAGE_SIZE);
388a9934668SKenneth D. Merry 	}
389a9934668SKenneth D. Merry 
390a9934668SKenneth D. Merry 	return (limited);
391a9934668SKenneth D. Merry }
392a9934668SKenneth D. Merry 
393dd84a43cSPoul-Henning Kamp static void
394dd84a43cSPoul-Henning Kamp g_disk_start(struct bio *bp)
395dd84a43cSPoul-Henning Kamp {
39615c672a3SPoul-Henning Kamp 	struct bio *bp2, *bp3;
397dd84a43cSPoul-Henning Kamp 	struct disk *dp;
398c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
399a5b2e75dSPoul-Henning Kamp 	int error;
400ccf8a568SAlexander Motin 	off_t off;
401dd84a43cSPoul-Henning Kamp 
40230ba7471SAlexander Motin 	sc = bp->bio_to->private;
403c6d4ed3aSAlexander Motin 	if (sc == NULL || (dp = sc->dp) == NULL || dp->d_destroyed) {
40467fd2837SPoul-Henning Kamp 		g_io_deliver(bp, ENXIO);
405b3fd9b46SPoul-Henning Kamp 		return;
406b3fd9b46SPoul-Henning Kamp 	}
407b362694cSPoul-Henning Kamp 	error = EJUSTRETURN;
408dd84a43cSPoul-Henning Kamp 	switch(bp->bio_cmd) {
409b362694cSPoul-Henning Kamp 	case BIO_DELETE:
41031a1093fSPoul-Henning Kamp 		if (!(dp->d_flags & DISKFLAG_CANDELETE)) {
41192f84a9fSPawel Jakub Dawidek 			error = EOPNOTSUPP;
412b362694cSPoul-Henning Kamp 			break;
413b362694cSPoul-Henning Kamp 		}
414b362694cSPoul-Henning Kamp 		/* fall-through */
415dd84a43cSPoul-Henning Kamp 	case BIO_READ:
416dd84a43cSPoul-Henning Kamp 	case BIO_WRITE:
417a9934668SKenneth D. Merry 		KASSERT((dp->d_flags & DISKFLAG_UNMAPPED_BIO) != 0 ||
418a9934668SKenneth D. Merry 		    (bp->bio_flags & BIO_UNMAPPED) == 0,
419a9934668SKenneth D. Merry 		    ("unmapped bio not supported by disk %s", dp->d_name));
42015c672a3SPoul-Henning Kamp 		off = 0;
42115c672a3SPoul-Henning Kamp 		bp3 = NULL;
422dd84a43cSPoul-Henning Kamp 		bp2 = g_clone_bio(bp);
423a4210653SPoul-Henning Kamp 		if (bp2 == NULL) {
424a4210653SPoul-Henning Kamp 			error = ENOMEM;
425a4210653SPoul-Henning Kamp 			break;
426a4210653SPoul-Henning Kamp 		}
427a9934668SKenneth D. Merry 		for (;;) {
428a9934668SKenneth D. Merry 			if (g_disk_limit(dp, bp2)) {
429a9934668SKenneth D. Merry 				off += bp2->bio_length;
430ccf8a568SAlexander Motin 
43115c672a3SPoul-Henning Kamp 				/*
43215c672a3SPoul-Henning Kamp 				 * To avoid a race, we need to grab the next bio
43315c672a3SPoul-Henning Kamp 				 * before we schedule this one.  See "notes".
43415c672a3SPoul-Henning Kamp 				 */
43515c672a3SPoul-Henning Kamp 				bp3 = g_clone_bio(bp);
43615c672a3SPoul-Henning Kamp 				if (bp3 == NULL)
43715c672a3SPoul-Henning Kamp 					bp->bio_error = ENOMEM;
43815c672a3SPoul-Henning Kamp 			}
439dd84a43cSPoul-Henning Kamp 			bp2->bio_done = g_disk_done;
440b362694cSPoul-Henning Kamp 			bp2->bio_pblkno = bp2->bio_offset / dp->d_sectorsize;
441dd84a43cSPoul-Henning Kamp 			bp2->bio_bcount = bp2->bio_length;
442ffa91881SPoul-Henning Kamp 			bp2->bio_disk = dp;
44340ea77a0SAlexander Motin 			mtx_lock(&sc->start_mtx);
4442e93e909STor Egge 			devstat_start_transaction_bio(dp->d_devstat, bp2);
44540ea77a0SAlexander Motin 			mtx_unlock(&sc->start_mtx);
44631a1093fSPoul-Henning Kamp 			dp->d_strategy(bp2);
447a9934668SKenneth D. Merry 
448a9934668SKenneth D. Merry 			if (bp3 == NULL)
449a9934668SKenneth D. Merry 				break;
450a9934668SKenneth D. Merry 
45115c672a3SPoul-Henning Kamp 			bp2 = bp3;
45215c672a3SPoul-Henning Kamp 			bp3 = NULL;
453a9934668SKenneth D. Merry 			g_disk_advance(dp, bp2, off);
454a9934668SKenneth D. Merry 		}
455dd84a43cSPoul-Henning Kamp 		break;
456dd84a43cSPoul-Henning Kamp 	case BIO_GETATTR:
457416494d7SJustin T. Gibbs 		/* Give the driver a chance to override */
458416494d7SJustin T. Gibbs 		if (dp->d_getattr != NULL) {
459416494d7SJustin T. Gibbs 			if (bp->bio_disk == NULL)
460416494d7SJustin T. Gibbs 				bp->bio_disk = dp;
461416494d7SJustin T. Gibbs 			error = dp->d_getattr(bp);
462416494d7SJustin T. Gibbs 			if (error != -1)
463416494d7SJustin T. Gibbs 				break;
464416494d7SJustin T. Gibbs 			error = EJUSTRETURN;
465416494d7SJustin T. Gibbs 		}
466d91e813cSKonstantin Belousov 		if (g_handleattr_int(bp, "GEOM::candelete",
467d91e813cSKonstantin Belousov 		    (dp->d_flags & DISKFLAG_CANDELETE) != 0))
468d91e813cSKonstantin Belousov 			break;
469d91e813cSKonstantin Belousov 		else if (g_handleattr_int(bp, "GEOM::fwsectors",
470d91e813cSKonstantin Belousov 		    dp->d_fwsectors))
471a5b2e75dSPoul-Henning Kamp 			break;
4727812d86fSPoul-Henning Kamp 		else if (g_handleattr_int(bp, "GEOM::fwheads", dp->d_fwheads))
473a5b2e75dSPoul-Henning Kamp 			break;
474503abe45SPoul-Henning Kamp 		else if (g_handleattr_off_t(bp, "GEOM::frontstuff", 0))
4751bdb20a6SPoul-Henning Kamp 			break;
476d0c11f9eSPawel Jakub Dawidek 		else if (g_handleattr_str(bp, "GEOM::ident", dp->d_ident))
477d0c11f9eSPawel Jakub Dawidek 			break;
478c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_vendor",
479c28078e9SSteven Hartland 		    dp->d_hba_vendor))
4808edcf694SAlexander Motin 			break;
481c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_device",
482c28078e9SSteven Hartland 		    dp->d_hba_device))
4838edcf694SAlexander Motin 			break;
484c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_subvendor",
485c28078e9SSteven Hartland 		    dp->d_hba_subvendor))
4868edcf694SAlexander Motin 			break;
487c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_subdevice",
488c28078e9SSteven Hartland 		    dp->d_hba_subdevice))
4898edcf694SAlexander Motin 			break;
49095c24b31SPoul-Henning Kamp 		else if (!strcmp(bp->bio_attribute, "GEOM::kerneldump"))
49195c24b31SPoul-Henning Kamp 			g_disk_kerneldump(bp, dp);
492c6d4ed3aSAlexander Motin 		else if (!strcmp(bp->bio_attribute, "GEOM::setstate"))
493c6d4ed3aSAlexander Motin 			g_disk_setstate(bp, sc);
494c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::rotation_rate",
495c28078e9SSteven Hartland 		    dp->d_rotation_rate))
496c28078e9SSteven Hartland 			break;
497497c3347SPoul-Henning Kamp 		else
498a5b2e75dSPoul-Henning Kamp 			error = ENOIOCTL;
499a5b2e75dSPoul-Henning Kamp 		break;
5001d2aee20SPawel Jakub Dawidek 	case BIO_FLUSH:
50185f5b9aaSAndriy Gapon 		g_trace(G_T_BIO, "g_disk_flushcache(%s)",
5021d2aee20SPawel Jakub Dawidek 		    bp->bio_to->name);
5031d2aee20SPawel Jakub Dawidek 		if (!(dp->d_flags & DISKFLAG_CANFLUSHCACHE)) {
50492f84a9fSPawel Jakub Dawidek 			error = EOPNOTSUPP;
50592f84a9fSPawel Jakub Dawidek 			break;
5061d2aee20SPawel Jakub Dawidek 		}
507ccf8a568SAlexander Motin 		bp2 = g_clone_bio(bp);
508ccf8a568SAlexander Motin 		if (bp2 == NULL) {
509ccf8a568SAlexander Motin 			g_io_deliver(bp, ENOMEM);
510ccf8a568SAlexander Motin 			return;
511ccf8a568SAlexander Motin 		}
512ccf8a568SAlexander Motin 		bp2->bio_done = g_disk_done;
513ccf8a568SAlexander Motin 		bp2->bio_disk = dp;
514413037c8SAlexander Motin 		mtx_lock(&sc->start_mtx);
515ccf8a568SAlexander Motin 		devstat_start_transaction_bio(dp->d_devstat, bp2);
516413037c8SAlexander Motin 		mtx_unlock(&sc->start_mtx);
517ccf8a568SAlexander Motin 		dp->d_strategy(bp2);
5181d2aee20SPawel Jakub Dawidek 		break;
519dd84a43cSPoul-Henning Kamp 	default:
520a5b2e75dSPoul-Henning Kamp 		error = EOPNOTSUPP;
521a5b2e75dSPoul-Henning Kamp 		break;
522dd84a43cSPoul-Henning Kamp 	}
523b362694cSPoul-Henning Kamp 	if (error != EJUSTRETURN)
52472840432SPoul-Henning Kamp 		g_io_deliver(bp, error);
525a5b2e75dSPoul-Henning Kamp 	return;
526dd84a43cSPoul-Henning Kamp }
527dd84a43cSPoul-Henning Kamp 
5288523987bSPoul-Henning Kamp static void
5290f9d3dbaSPoul-Henning Kamp g_disk_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp, struct g_provider *pp)
5308f9628a1SPoul-Henning Kamp {
531ccba7102SAlexander Motin 	struct bio *bp;
5328f9628a1SPoul-Henning Kamp 	struct disk *dp;
533c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
534ccba7102SAlexander Motin 	char *buf;
535ccba7102SAlexander Motin 	int res = 0;
5368f9628a1SPoul-Henning Kamp 
537c6d4ed3aSAlexander Motin 	sc = gp->softc;
538c6d4ed3aSAlexander Motin 	if (sc == NULL || (dp = sc->dp) == NULL)
539eb98005fSPoul-Henning Kamp 		return;
540d518e539SPoul-Henning Kamp 	if (indent == NULL) {
541d518e539SPoul-Henning Kamp 		sbuf_printf(sb, " hd %u", dp->d_fwheads);
542d518e539SPoul-Henning Kamp 		sbuf_printf(sb, " sc %u", dp->d_fwsectors);
543d518e539SPoul-Henning Kamp 		return;
544d518e539SPoul-Henning Kamp 	}
5459e2ebaa0SPoul-Henning Kamp 	if (pp != NULL) {
5468f9628a1SPoul-Henning Kamp 		sbuf_printf(sb, "%s<fwheads>%u</fwheads>\n",
5478f9628a1SPoul-Henning Kamp 		    indent, dp->d_fwheads);
5488f9628a1SPoul-Henning Kamp 		sbuf_printf(sb, "%s<fwsectors>%u</fwsectors>\n",
5498f9628a1SPoul-Henning Kamp 		    indent, dp->d_fwsectors);
550ccba7102SAlexander Motin 		if (dp->d_getattr != NULL) {
551ccba7102SAlexander Motin 			buf = g_malloc(DISK_IDENT_SIZE, M_WAITOK);
552ccba7102SAlexander Motin 			bp = g_alloc_bio();
553ccba7102SAlexander Motin 			bp->bio_disk = dp;
554ccba7102SAlexander Motin 			bp->bio_attribute = "GEOM::ident";
555ccba7102SAlexander Motin 			bp->bio_length = DISK_IDENT_SIZE;
556ccba7102SAlexander Motin 			bp->bio_data = buf;
557ccba7102SAlexander Motin 			res = dp->d_getattr(bp);
5587ae1a87bSAlexander Motin 			sbuf_printf(sb, "%s<ident>", indent);
5597ae1a87bSAlexander Motin 			g_conf_printf_escaped(sb, "%s",
560ccba7102SAlexander Motin 			    res == 0 ? buf: dp->d_ident);
5617ae1a87bSAlexander Motin 			sbuf_printf(sb, "</ident>\n");
562ccba7102SAlexander Motin 			bp->bio_attribute = "GEOM::lunid";
563ccba7102SAlexander Motin 			bp->bio_length = DISK_IDENT_SIZE;
564ccba7102SAlexander Motin 			bp->bio_data = buf;
5657ae1a87bSAlexander Motin 			if (dp->d_getattr(bp) == 0) {
5667ae1a87bSAlexander Motin 				sbuf_printf(sb, "%s<lunid>", indent);
5677ae1a87bSAlexander Motin 				g_conf_printf_escaped(sb, "%s", buf);
5687ae1a87bSAlexander Motin 				sbuf_printf(sb, "</lunid>\n");
5697ae1a87bSAlexander Motin 			}
57040f27d7cSAlexander Motin 			bp->bio_attribute = "GEOM::lunname";
57140f27d7cSAlexander Motin 			bp->bio_length = DISK_IDENT_SIZE;
57240f27d7cSAlexander Motin 			bp->bio_data = buf;
5737ae1a87bSAlexander Motin 			if (dp->d_getattr(bp) == 0) {
5747ae1a87bSAlexander Motin 				sbuf_printf(sb, "%s<lunname>", indent);
5757ae1a87bSAlexander Motin 				g_conf_printf_escaped(sb, "%s", buf);
5767ae1a87bSAlexander Motin 				sbuf_printf(sb, "</lunname>\n");
5777ae1a87bSAlexander Motin 			}
578ccba7102SAlexander Motin 			g_destroy_bio(bp);
579ccba7102SAlexander Motin 			g_free(buf);
5807ae1a87bSAlexander Motin 		} else {
5817ae1a87bSAlexander Motin 			sbuf_printf(sb, "%s<ident>", indent);
5827ae1a87bSAlexander Motin 			g_conf_printf_escaped(sb, "%s", dp->d_ident);
5837ae1a87bSAlexander Motin 			sbuf_printf(sb, "</ident>\n");
5847ae1a87bSAlexander Motin 		}
5857ae1a87bSAlexander Motin 		sbuf_printf(sb, "%s<descr>", indent);
5867ae1a87bSAlexander Motin 		g_conf_printf_escaped(sb, "%s", dp->d_descr);
5877ae1a87bSAlexander Motin 		sbuf_printf(sb, "</descr>\n");
5888f9628a1SPoul-Henning Kamp 	}
5898f9628a1SPoul-Henning Kamp }
5908f9628a1SPoul-Henning Kamp 
5918f9628a1SPoul-Henning Kamp static void
5921af2d09bSEdward Tomasz Napierala g_disk_resize(void *ptr, int flag)
593bc97ce36SEdward Tomasz Napierala {
5941af2d09bSEdward Tomasz Napierala 	struct disk *dp;
595bc97ce36SEdward Tomasz Napierala 	struct g_geom *gp;
596bc97ce36SEdward Tomasz Napierala 	struct g_provider *pp;
597bc97ce36SEdward Tomasz Napierala 
5981af2d09bSEdward Tomasz Napierala 	if (flag == EV_CANCEL)
5991af2d09bSEdward Tomasz Napierala 		return;
6001af2d09bSEdward Tomasz Napierala 	g_topology_assert();
6011af2d09bSEdward Tomasz Napierala 
6021af2d09bSEdward Tomasz Napierala 	dp = ptr;
603bc97ce36SEdward Tomasz Napierala 	gp = dp->d_geom;
604bc97ce36SEdward Tomasz Napierala 
6051af2d09bSEdward Tomasz Napierala 	if (dp->d_destroyed || gp == NULL)
6061af2d09bSEdward Tomasz Napierala 		return;
6071af2d09bSEdward Tomasz Napierala 
608bc97ce36SEdward Tomasz Napierala 	LIST_FOREACH(pp, &gp->provider, provider) {
609bc97ce36SEdward Tomasz Napierala 		if (pp->sectorsize != 0 &&
610bc97ce36SEdward Tomasz Napierala 		    pp->sectorsize != dp->d_sectorsize)
611bc97ce36SEdward Tomasz Napierala 			g_wither_provider(pp, ENXIO);
612bc97ce36SEdward Tomasz Napierala 		else
613bc97ce36SEdward Tomasz Napierala 			g_resize_provider(pp, dp->d_mediasize);
614bc97ce36SEdward Tomasz Napierala 	}
615bc97ce36SEdward Tomasz Napierala }
616bc97ce36SEdward Tomasz Napierala 
617bc97ce36SEdward Tomasz Napierala static void
61843f0db6cSPoul-Henning Kamp g_disk_create(void *arg, int flag)
619dd84a43cSPoul-Henning Kamp {
620dd84a43cSPoul-Henning Kamp 	struct g_geom *gp;
621dd84a43cSPoul-Henning Kamp 	struct g_provider *pp;
622bb17c5f6SPoul-Henning Kamp 	struct disk *dp;
623c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
624c6d4ed3aSAlexander Motin 	char tmpstr[80];
625dd84a43cSPoul-Henning Kamp 
62643f0db6cSPoul-Henning Kamp 	if (flag == EV_CANCEL)
62743f0db6cSPoul-Henning Kamp 		return;
6288523987bSPoul-Henning Kamp 	g_topology_assert();
629bb17c5f6SPoul-Henning Kamp 	dp = arg;
630c6d4ed3aSAlexander Motin 	sc = g_malloc(sizeof(*sc), M_WAITOK | M_ZERO);
63140ea77a0SAlexander Motin 	mtx_init(&sc->start_mtx, "g_disk_start", NULL, MTX_DEF);
63230ba7471SAlexander Motin 	mtx_init(&sc->done_mtx, "g_disk_done", NULL, MTX_DEF);
633c6d4ed3aSAlexander Motin 	sc->dp = dp;
634bb17c5f6SPoul-Henning Kamp 	gp = g_new_geomf(&g_disk_class, "%s%d", dp->d_name, dp->d_unit);
635c6d4ed3aSAlexander Motin 	gp->softc = sc;
6368523987bSPoul-Henning Kamp 	pp = g_new_providerf(gp, "%s", gp->name);
63740ea77a0SAlexander Motin 	devstat_remove_entry(pp->stat);
63840ea77a0SAlexander Motin 	pp->stat = NULL;
63940ea77a0SAlexander Motin 	dp->d_devstat->id = pp;
640bb17c5f6SPoul-Henning Kamp 	pp->mediasize = dp->d_mediasize;
641bb17c5f6SPoul-Henning Kamp 	pp->sectorsize = dp->d_sectorsize;
6428a63edc3SPoul-Henning Kamp 	pp->stripeoffset = dp->d_stripeoffset;
6438a63edc3SPoul-Henning Kamp 	pp->stripesize = dp->d_stripesize;
644f8c19ba4SKonstantin Belousov 	if ((dp->d_flags & DISKFLAG_UNMAPPED_BIO) != 0)
645f8c19ba4SKonstantin Belousov 		pp->flags |= G_PF_ACCEPT_UNMAPPED;
64640ea77a0SAlexander Motin 	if ((dp->d_flags & DISKFLAG_DIRECT_COMPLETION) != 0)
64740ea77a0SAlexander Motin 		pp->flags |= G_PF_DIRECT_SEND;
64840ea77a0SAlexander Motin 	pp->flags |= G_PF_DIRECT_RECEIVE;
6493d5500fcSPoul-Henning Kamp 	if (bootverbose)
6503d5500fcSPoul-Henning Kamp 		printf("GEOM: new disk %s\n", gp->name);
651c6d4ed3aSAlexander Motin 	sysctl_ctx_init(&sc->sysctl_ctx);
652c6d4ed3aSAlexander Motin 	snprintf(tmpstr, sizeof(tmpstr), "GEOM disk %s", gp->name);
653c6d4ed3aSAlexander Motin 	sc->sysctl_tree = SYSCTL_ADD_NODE(&sc->sysctl_ctx,
654c6d4ed3aSAlexander Motin 		SYSCTL_STATIC_CHILDREN(_kern_geom_disk), OID_AUTO, gp->name,
655c6d4ed3aSAlexander Motin 		CTLFLAG_RD, 0, tmpstr);
656c6d4ed3aSAlexander Motin 	if (sc->sysctl_tree != NULL) {
657c6d4ed3aSAlexander Motin 		SYSCTL_ADD_STRING(&sc->sysctl_ctx,
658c6d4ed3aSAlexander Motin 		    SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO, "led",
659af3b2549SHans Petter Selasky 		    CTLFLAG_RWTUN, sc->led, sizeof(sc->led),
660c6d4ed3aSAlexander Motin 		    "LED name");
661c6d4ed3aSAlexander Motin 	}
662c6d4ed3aSAlexander Motin 	pp->private = sc;
663316aed03SPoul-Henning Kamp 	dp->d_geom = gp;
664316aed03SPoul-Henning Kamp 	g_error_provider(pp, 0);
665dd84a43cSPoul-Henning Kamp }
6668523987bSPoul-Henning Kamp 
667c3fb2891SKenneth D. Merry /*
668c3fb2891SKenneth D. Merry  * We get this callback after all of the consumers have gone away, and just
669c3fb2891SKenneth D. Merry  * before the provider is freed.  If the disk driver provided a d_gone
670c3fb2891SKenneth D. Merry  * callback, let them know that it is okay to free resources -- they won't
671c3fb2891SKenneth D. Merry  * be getting any more accesses from GEOM.
672c3fb2891SKenneth D. Merry  */
673c3fb2891SKenneth D. Merry static void
674c3fb2891SKenneth D. Merry g_disk_providergone(struct g_provider *pp)
675c3fb2891SKenneth D. Merry {
676c3fb2891SKenneth D. Merry 	struct disk *dp;
677c3fb2891SKenneth D. Merry 	struct g_disk_softc *sc;
678c3fb2891SKenneth D. Merry 
67930ba7471SAlexander Motin 	sc = (struct g_disk_softc *)pp->private;
680c3fb2891SKenneth D. Merry 	dp = sc->dp;
68130ba7471SAlexander Motin 	if (dp != NULL && dp->d_gone != NULL)
682c3fb2891SKenneth D. Merry 		dp->d_gone(dp);
68330ba7471SAlexander Motin 	if (sc->sysctl_tree != NULL) {
68430ba7471SAlexander Motin 		sysctl_ctx_free(&sc->sysctl_ctx);
68530ba7471SAlexander Motin 		sc->sysctl_tree = NULL;
68630ba7471SAlexander Motin 	}
68730ba7471SAlexander Motin 	if (sc->led[0] != 0) {
68830ba7471SAlexander Motin 		led_set(sc->led, "0");
68930ba7471SAlexander Motin 		sc->led[0] = 0;
69030ba7471SAlexander Motin 	}
69130ba7471SAlexander Motin 	pp->private = NULL;
69230ba7471SAlexander Motin 	pp->geom->softc = NULL;
69330ba7471SAlexander Motin 	mtx_destroy(&sc->done_mtx);
69440ea77a0SAlexander Motin 	mtx_destroy(&sc->start_mtx);
69530ba7471SAlexander Motin 	g_free(sc);
696c3fb2891SKenneth D. Merry }
697c3fb2891SKenneth D. Merry 
698ce1ee789SPoul-Henning Kamp static void
699ce1ee789SPoul-Henning Kamp g_disk_destroy(void *ptr, int flag)
700ce1ee789SPoul-Henning Kamp {
7010b7ed341SPoul-Henning Kamp 	struct disk *dp;
702ce1ee789SPoul-Henning Kamp 	struct g_geom *gp;
703c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
7048523987bSPoul-Henning Kamp 
705ce1ee789SPoul-Henning Kamp 	g_topology_assert();
7060b7ed341SPoul-Henning Kamp 	dp = ptr;
7070b7ed341SPoul-Henning Kamp 	gp = dp->d_geom;
708032bc81dSPoul-Henning Kamp 	if (gp != NULL) {
709c6d4ed3aSAlexander Motin 		sc = gp->softc;
71030ba7471SAlexander Motin 		if (sc != NULL)
71130ba7471SAlexander Motin 			sc->dp = NULL;
71230ba7471SAlexander Motin 		dp->d_geom = NULL;
713ce1ee789SPoul-Henning Kamp 		g_wither_geom(gp, ENXIO);
714032bc81dSPoul-Henning Kamp 	}
7150b7ed341SPoul-Henning Kamp 	g_free(dp);
7160b7ed341SPoul-Henning Kamp }
7170b7ed341SPoul-Henning Kamp 
7185e16a486SPawel Jakub Dawidek /*
719e93f5e4dSPawel Jakub Dawidek  * We only allow printable characters in disk ident,
720e93f5e4dSPawel Jakub Dawidek  * the rest is converted to 'x<HH>'.
7215e16a486SPawel Jakub Dawidek  */
7225e16a486SPawel Jakub Dawidek static void
7235e16a486SPawel Jakub Dawidek g_disk_ident_adjust(char *ident, size_t size)
7245e16a486SPawel Jakub Dawidek {
725e93f5e4dSPawel Jakub Dawidek 	char *p, tmp[4], newid[DISK_IDENT_SIZE];
7265e16a486SPawel Jakub Dawidek 
727e93f5e4dSPawel Jakub Dawidek 	newid[0] = '\0';
728e93f5e4dSPawel Jakub Dawidek 	for (p = ident; *p != '\0'; p++) {
729e93f5e4dSPawel Jakub Dawidek 		if (isprint(*p)) {
730e93f5e4dSPawel Jakub Dawidek 			tmp[0] = *p;
731e93f5e4dSPawel Jakub Dawidek 			tmp[1] = '\0';
732e93f5e4dSPawel Jakub Dawidek 		} else {
733e93f5e4dSPawel Jakub Dawidek 			snprintf(tmp, sizeof(tmp), "x%02hhx",
734e93f5e4dSPawel Jakub Dawidek 			    *(unsigned char *)p);
7355e16a486SPawel Jakub Dawidek 		}
736e93f5e4dSPawel Jakub Dawidek 		if (strlcat(newid, tmp, sizeof(newid)) >= sizeof(newid))
7375e16a486SPawel Jakub Dawidek 			break;
7385e16a486SPawel Jakub Dawidek 	}
7395e16a486SPawel Jakub Dawidek 	bzero(ident, size);
7405e16a486SPawel Jakub Dawidek 	strlcpy(ident, newid, size);
7415e16a486SPawel Jakub Dawidek }
7425e16a486SPawel Jakub Dawidek 
7430b7ed341SPoul-Henning Kamp struct disk *
74494954762SPawel Jakub Dawidek disk_alloc(void)
7450b7ed341SPoul-Henning Kamp {
7460b7ed341SPoul-Henning Kamp 
74794954762SPawel Jakub Dawidek 	return (g_malloc(sizeof(struct disk), M_WAITOK | M_ZERO));
748ce1ee789SPoul-Henning Kamp }
7498523987bSPoul-Henning Kamp 
75098bbd7aaSPoul-Henning Kamp void
7510b7ed341SPoul-Henning Kamp disk_create(struct disk *dp, int version)
7528523987bSPoul-Henning Kamp {
75337f0f0a7SPawel Jakub Dawidek 
7548383a92eSSteven Hartland 	if (version != DISK_VERSION) {
7550b7ed341SPoul-Henning Kamp 		printf("WARNING: Attempt to add disk %s%d %s",
7560b7ed341SPoul-Henning Kamp 		    dp->d_name, dp->d_unit,
7570b7ed341SPoul-Henning Kamp 		    " using incompatible ABI version of disk(9)\n");
7580b7ed341SPoul-Henning Kamp 		printf("WARNING: Ignoring disk %s%d\n",
7590b7ed341SPoul-Henning Kamp 		    dp->d_name, dp->d_unit);
7600b7ed341SPoul-Henning Kamp 		return;
7610b7ed341SPoul-Henning Kamp 	}
762d6d78db5SJohn Baldwin 	if (dp->d_flags & DISKFLAG_RESERVED) {
763d6d78db5SJohn Baldwin 		printf("WARNING: Attempt to add non-MPSAFE disk %s%d\n",
764d6d78db5SJohn Baldwin 		    dp->d_name, dp->d_unit);
765d6d78db5SJohn Baldwin 		printf("WARNING: Ignoring disk %s%d\n",
766d6d78db5SJohn Baldwin 		    dp->d_name, dp->d_unit);
767d6d78db5SJohn Baldwin 		return;
768d6d78db5SJohn Baldwin 	}
76931a1093fSPoul-Henning Kamp 	KASSERT(dp->d_strategy != NULL, ("disk_create need d_strategy"));
77031a1093fSPoul-Henning Kamp 	KASSERT(dp->d_name != NULL, ("disk_create need d_name"));
77131a1093fSPoul-Henning Kamp 	KASSERT(*dp->d_name != 0, ("disk_create need d_name"));
772237d2765SPoul-Henning Kamp 	KASSERT(strlen(dp->d_name) < SPECNAMELEN - 4, ("disk name too long"));
773eb98005fSPoul-Henning Kamp 	if (dp->d_devstat == NULL)
77409f95804SPoul-Henning Kamp 		dp->d_devstat = devstat_new_entry(dp->d_name, dp->d_unit,
77560794e04SPoul-Henning Kamp 		    dp->d_sectorsize, DEVSTAT_ALL_SUPPORTED,
77660794e04SPoul-Henning Kamp 		    DEVSTAT_TYPE_DIRECT, DEVSTAT_PRIORITY_MAX);
777316aed03SPoul-Henning Kamp 	dp->d_geom = NULL;
7785e16a486SPawel Jakub Dawidek 	g_disk_ident_adjust(dp->d_ident, sizeof(dp->d_ident));
7798cd1535aSPoul-Henning Kamp 	g_post_event(g_disk_create, dp, M_WAITOK, dp, NULL);
780dd84a43cSPoul-Henning Kamp }
781dd84a43cSPoul-Henning Kamp 
782dd84a43cSPoul-Henning Kamp void
783b82ff758SPoul-Henning Kamp disk_destroy(struct disk *dp)
784dd84a43cSPoul-Henning Kamp {
785dd84a43cSPoul-Henning Kamp 
786316aed03SPoul-Henning Kamp 	g_cancel_event(dp);
7870b7ed341SPoul-Henning Kamp 	dp->d_destroyed = 1;
78852c583feSPoul-Henning Kamp 	if (dp->d_devstat != NULL)
78952c583feSPoul-Henning Kamp 		devstat_remove_entry(dp->d_devstat);
79011e9a679SPoul-Henning Kamp 	g_post_event(g_disk_destroy, dp, M_WAITOK, NULL);
791dd84a43cSPoul-Henning Kamp }
792dd84a43cSPoul-Henning Kamp 
793a7e69e8bSJohn Polstra void
794a7e69e8bSJohn Polstra disk_gone(struct disk *dp)
795a7e69e8bSJohn Polstra {
796a7e69e8bSJohn Polstra 	struct g_geom *gp;
797a7e69e8bSJohn Polstra 	struct g_provider *pp;
798a7e69e8bSJohn Polstra 
799a7e69e8bSJohn Polstra 	gp = dp->d_geom;
800171f6b3aSPawel Jakub Dawidek 	if (gp != NULL) {
8015d8a6a10SPawel Jakub Dawidek 		pp = LIST_FIRST(&gp->provider);
8025d8a6a10SPawel Jakub Dawidek 		if (pp != NULL) {
8035d8a6a10SPawel Jakub Dawidek 			KASSERT(LIST_NEXT(pp, provider) == NULL,
8045d8a6a10SPawel Jakub Dawidek 			    ("geom %p has more than one provider", gp));
805d99c1559SMarcel Moolenaar 			g_wither_provider(pp, ENXIO);
806a7e69e8bSJohn Polstra 		}
8075d8a6a10SPawel Jakub Dawidek 	}
808171f6b3aSPawel Jakub Dawidek }
809a7e69e8bSJohn Polstra 
810416494d7SJustin T. Gibbs void
811416494d7SJustin T. Gibbs disk_attr_changed(struct disk *dp, const char *attr, int flag)
812416494d7SJustin T. Gibbs {
813416494d7SJustin T. Gibbs 	struct g_geom *gp;
814416494d7SJustin T. Gibbs 	struct g_provider *pp;
815416494d7SJustin T. Gibbs 
816416494d7SJustin T. Gibbs 	gp = dp->d_geom;
817416494d7SJustin T. Gibbs 	if (gp != NULL)
818416494d7SJustin T. Gibbs 		LIST_FOREACH(pp, &gp->provider, provider)
819416494d7SJustin T. Gibbs 			(void)g_attr_changed(pp, attr, flag);
820416494d7SJustin T. Gibbs }
821416494d7SJustin T. Gibbs 
822bc97ce36SEdward Tomasz Napierala void
8233631c638SAlexander Motin disk_media_changed(struct disk *dp, int flag)
8243631c638SAlexander Motin {
8253631c638SAlexander Motin 	struct g_geom *gp;
8263631c638SAlexander Motin 	struct g_provider *pp;
8273631c638SAlexander Motin 
8283631c638SAlexander Motin 	gp = dp->d_geom;
8293631c638SAlexander Motin 	if (gp != NULL) {
8300fb832fdSAlexander Motin 		pp = LIST_FIRST(&gp->provider);
8310fb832fdSAlexander Motin 		if (pp != NULL) {
8320fb832fdSAlexander Motin 			KASSERT(LIST_NEXT(pp, provider) == NULL,
8330fb832fdSAlexander Motin 			    ("geom %p has more than one provider", gp));
8343631c638SAlexander Motin 			g_media_changed(pp, flag);
8353631c638SAlexander Motin 		}
8363631c638SAlexander Motin 	}
8370fb832fdSAlexander Motin }
8383631c638SAlexander Motin 
8393631c638SAlexander Motin void
8403631c638SAlexander Motin disk_media_gone(struct disk *dp, int flag)
8413631c638SAlexander Motin {
8423631c638SAlexander Motin 	struct g_geom *gp;
8433631c638SAlexander Motin 	struct g_provider *pp;
8443631c638SAlexander Motin 
8453631c638SAlexander Motin 	gp = dp->d_geom;
8463631c638SAlexander Motin 	if (gp != NULL) {
8470fb832fdSAlexander Motin 		pp = LIST_FIRST(&gp->provider);
8480fb832fdSAlexander Motin 		if (pp != NULL) {
8490fb832fdSAlexander Motin 			KASSERT(LIST_NEXT(pp, provider) == NULL,
8500fb832fdSAlexander Motin 			    ("geom %p has more than one provider", gp));
8513631c638SAlexander Motin 			g_media_gone(pp, flag);
8523631c638SAlexander Motin 		}
8533631c638SAlexander Motin 	}
8540fb832fdSAlexander Motin }
8553631c638SAlexander Motin 
8561af2d09bSEdward Tomasz Napierala int
8571af2d09bSEdward Tomasz Napierala disk_resize(struct disk *dp, int flag)
858bc97ce36SEdward Tomasz Napierala {
859bc97ce36SEdward Tomasz Napierala 
8601af2d09bSEdward Tomasz Napierala 	if (dp->d_destroyed || dp->d_geom == NULL)
8611af2d09bSEdward Tomasz Napierala 		return (0);
862bc97ce36SEdward Tomasz Napierala 
8631af2d09bSEdward Tomasz Napierala 	return (g_post_event(g_disk_resize, dp, flag, NULL));
864bc97ce36SEdward Tomasz Napierala }
865bc97ce36SEdward Tomasz Napierala 
8660cc3011dSPoul-Henning Kamp static void
867afcbcfaeSPoul-Henning Kamp g_kern_disks(void *p, int flag __unused)
8680cc3011dSPoul-Henning Kamp {
8690cc3011dSPoul-Henning Kamp 	struct sbuf *sb;
8700cc3011dSPoul-Henning Kamp 	struct g_geom *gp;
8710cc3011dSPoul-Henning Kamp 	char *sp;
8720cc3011dSPoul-Henning Kamp 
8730cc3011dSPoul-Henning Kamp 	sb = p;
8740cc3011dSPoul-Henning Kamp 	sp = "";
8750cc3011dSPoul-Henning Kamp 	g_topology_assert();
8760cc3011dSPoul-Henning Kamp 	LIST_FOREACH(gp, &g_disk_class.geom, geom) {
8770cc3011dSPoul-Henning Kamp 		sbuf_printf(sb, "%s%s", sp, gp->name);
8780cc3011dSPoul-Henning Kamp 		sp = " ";
8790cc3011dSPoul-Henning Kamp 	}
8800cc3011dSPoul-Henning Kamp 	sbuf_finish(sb);
8810cc3011dSPoul-Henning Kamp }
8820cc3011dSPoul-Henning Kamp 
8830cc3011dSPoul-Henning Kamp static int
8840cc3011dSPoul-Henning Kamp sysctl_disks(SYSCTL_HANDLER_ARGS)
8850cc3011dSPoul-Henning Kamp {
8860cc3011dSPoul-Henning Kamp 	int error;
8870cc3011dSPoul-Henning Kamp 	struct sbuf *sb;
8880cc3011dSPoul-Henning Kamp 
8892616144eSDag-Erling Smørgrav 	sb = sbuf_new_auto();
8900a9c130cSPoul-Henning Kamp 	g_waitfor_event(g_kern_disks, sb, M_WAITOK, NULL);
891aed99af2SPoul-Henning Kamp 	error = SYSCTL_OUT(req, sbuf_data(sb), sbuf_len(sb) + 1);
8920cc3011dSPoul-Henning Kamp 	sbuf_delete(sb);
8930cc3011dSPoul-Henning Kamp 	return error;
8940cc3011dSPoul-Henning Kamp }
8950cc3011dSPoul-Henning Kamp 
89673d6f851SMatthew D Fleming SYSCTL_PROC(_kern, OID_AUTO, disks,
89773d6f851SMatthew D Fleming     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0,
8980cc3011dSPoul-Henning Kamp     sysctl_disks, "A", "names of available disks");
899