xref: /freebsd/sys/geom/geom_disk.c (revision cb03a5029b2dad93d032b3ed7e9e845c56c4924f)
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 
25642fbdde4SKenneth D. Merry static off_t
25742fbdde4SKenneth D. Merry g_disk_maxsize(struct disk *dp, struct bio *bp)
258a9934668SKenneth D. Merry {
25942fbdde4SKenneth D. Merry 	if (bp->bio_cmd == BIO_DELETE)
26042fbdde4SKenneth D. Merry 		return (dp->d_delmaxsize);
26142fbdde4SKenneth D. Merry 	return (dp->d_maxsize);
26242fbdde4SKenneth D. Merry }
26342fbdde4SKenneth D. Merry 
26442fbdde4SKenneth D. Merry static int
26542fbdde4SKenneth D. Merry g_disk_maxsegs(struct disk *dp, struct bio *bp)
26642fbdde4SKenneth D. Merry {
26742fbdde4SKenneth 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;
34542fbdde4SKenneth 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;
361985108aeSKenneth D. Merry 	off_t maxsz;
362985108aeSKenneth D. Merry 
363985108aeSKenneth D. Merry 	maxsz = g_disk_maxsize(dp, bp);
364a9934668SKenneth D. Merry 
365a9934668SKenneth D. Merry 	/*
366a9934668SKenneth D. Merry 	 * XXX: If we have a stripesize we should really use it here.
367a9934668SKenneth D. Merry 	 *      Care should be taken in the delete case if this is done
368a9934668SKenneth D. Merry 	 *      as deletes can be very sensitive to size given how they
369a9934668SKenneth D. Merry 	 *      are processed.
370a9934668SKenneth D. Merry 	 */
37142fbdde4SKenneth D. Merry 	if (bp->bio_length > maxsz) {
37242fbdde4SKenneth D. Merry 		bp->bio_length = maxsz;
373a9934668SKenneth D. Merry 		limited = true;
374a9934668SKenneth D. Merry 	}
375a9934668SKenneth D. Merry 
376a9934668SKenneth D. Merry 	if ((bp->bio_flags & BIO_VLIST) != 0) {
377a9934668SKenneth D. Merry 		bus_dma_segment_t *firstseg, *endseg;
378a9934668SKenneth D. Merry 		off_t residual;
379a9934668SKenneth D. Merry 
380a9934668SKenneth D. Merry 		firstseg = (bus_dma_segment_t*)bp->bio_data;
381a9934668SKenneth D. Merry 		residual = g_disk_vlist_limit(dp, bp, &endseg);
382a9934668SKenneth D. Merry 		if (residual != 0) {
383a9934668SKenneth D. Merry 			bp->bio_ma_n = endseg - firstseg;
384a9934668SKenneth D. Merry 			bp->bio_length -= residual;
385a9934668SKenneth D. Merry 			limited = true;
386a9934668SKenneth D. Merry 		}
387a9934668SKenneth D. Merry 	} else if ((bp->bio_flags & BIO_UNMAPPED) != 0) {
388a9934668SKenneth D. Merry 		bp->bio_ma_n =
389a9934668SKenneth D. Merry 		    howmany(bp->bio_ma_offset + bp->bio_length, PAGE_SIZE);
390a9934668SKenneth D. Merry 	}
391a9934668SKenneth D. Merry 
392a9934668SKenneth D. Merry 	return (limited);
393a9934668SKenneth D. Merry }
394a9934668SKenneth D. Merry 
395dd84a43cSPoul-Henning Kamp static void
396dd84a43cSPoul-Henning Kamp g_disk_start(struct bio *bp)
397dd84a43cSPoul-Henning Kamp {
39815c672a3SPoul-Henning Kamp 	struct bio *bp2, *bp3;
399dd84a43cSPoul-Henning Kamp 	struct disk *dp;
400c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
401a5b2e75dSPoul-Henning Kamp 	int error;
402ccf8a568SAlexander Motin 	off_t off;
403dd84a43cSPoul-Henning Kamp 
40430ba7471SAlexander Motin 	sc = bp->bio_to->private;
405c6d4ed3aSAlexander Motin 	if (sc == NULL || (dp = sc->dp) == NULL || dp->d_destroyed) {
40667fd2837SPoul-Henning Kamp 		g_io_deliver(bp, ENXIO);
407b3fd9b46SPoul-Henning Kamp 		return;
408b3fd9b46SPoul-Henning Kamp 	}
409b362694cSPoul-Henning Kamp 	error = EJUSTRETURN;
410dd84a43cSPoul-Henning Kamp 	switch(bp->bio_cmd) {
411b362694cSPoul-Henning Kamp 	case BIO_DELETE:
41231a1093fSPoul-Henning Kamp 		if (!(dp->d_flags & DISKFLAG_CANDELETE)) {
41392f84a9fSPawel Jakub Dawidek 			error = EOPNOTSUPP;
414b362694cSPoul-Henning Kamp 			break;
415b362694cSPoul-Henning Kamp 		}
416b362694cSPoul-Henning Kamp 		/* fall-through */
417dd84a43cSPoul-Henning Kamp 	case BIO_READ:
418dd84a43cSPoul-Henning Kamp 	case BIO_WRITE:
419a9934668SKenneth D. Merry 		KASSERT((dp->d_flags & DISKFLAG_UNMAPPED_BIO) != 0 ||
420a9934668SKenneth D. Merry 		    (bp->bio_flags & BIO_UNMAPPED) == 0,
421a9934668SKenneth D. Merry 		    ("unmapped bio not supported by disk %s", dp->d_name));
42215c672a3SPoul-Henning Kamp 		off = 0;
42315c672a3SPoul-Henning Kamp 		bp3 = NULL;
424dd84a43cSPoul-Henning Kamp 		bp2 = g_clone_bio(bp);
425a4210653SPoul-Henning Kamp 		if (bp2 == NULL) {
426a4210653SPoul-Henning Kamp 			error = ENOMEM;
427a4210653SPoul-Henning Kamp 			break;
428a4210653SPoul-Henning Kamp 		}
429a9934668SKenneth D. Merry 		for (;;) {
430a9934668SKenneth D. Merry 			if (g_disk_limit(dp, bp2)) {
431a9934668SKenneth D. Merry 				off += bp2->bio_length;
432ccf8a568SAlexander Motin 
43315c672a3SPoul-Henning Kamp 				/*
43415c672a3SPoul-Henning Kamp 				 * To avoid a race, we need to grab the next bio
43515c672a3SPoul-Henning Kamp 				 * before we schedule this one.  See "notes".
43615c672a3SPoul-Henning Kamp 				 */
43715c672a3SPoul-Henning Kamp 				bp3 = g_clone_bio(bp);
43815c672a3SPoul-Henning Kamp 				if (bp3 == NULL)
43915c672a3SPoul-Henning Kamp 					bp->bio_error = ENOMEM;
44015c672a3SPoul-Henning Kamp 			}
441dd84a43cSPoul-Henning Kamp 			bp2->bio_done = g_disk_done;
442b362694cSPoul-Henning Kamp 			bp2->bio_pblkno = bp2->bio_offset / dp->d_sectorsize;
443dd84a43cSPoul-Henning Kamp 			bp2->bio_bcount = bp2->bio_length;
444ffa91881SPoul-Henning Kamp 			bp2->bio_disk = dp;
44540ea77a0SAlexander Motin 			mtx_lock(&sc->start_mtx);
4462e93e909STor Egge 			devstat_start_transaction_bio(dp->d_devstat, bp2);
44740ea77a0SAlexander Motin 			mtx_unlock(&sc->start_mtx);
44831a1093fSPoul-Henning Kamp 			dp->d_strategy(bp2);
449a9934668SKenneth D. Merry 
450a9934668SKenneth D. Merry 			if (bp3 == NULL)
451a9934668SKenneth D. Merry 				break;
452a9934668SKenneth D. Merry 
45315c672a3SPoul-Henning Kamp 			bp2 = bp3;
45415c672a3SPoul-Henning Kamp 			bp3 = NULL;
455a9934668SKenneth D. Merry 			g_disk_advance(dp, bp2, off);
456a9934668SKenneth D. Merry 		}
457dd84a43cSPoul-Henning Kamp 		break;
458dd84a43cSPoul-Henning Kamp 	case BIO_GETATTR:
459416494d7SJustin T. Gibbs 		/* Give the driver a chance to override */
460416494d7SJustin T. Gibbs 		if (dp->d_getattr != NULL) {
461416494d7SJustin T. Gibbs 			if (bp->bio_disk == NULL)
462416494d7SJustin T. Gibbs 				bp->bio_disk = dp;
463416494d7SJustin T. Gibbs 			error = dp->d_getattr(bp);
464416494d7SJustin T. Gibbs 			if (error != -1)
465416494d7SJustin T. Gibbs 				break;
466416494d7SJustin T. Gibbs 			error = EJUSTRETURN;
467416494d7SJustin T. Gibbs 		}
468d91e813cSKonstantin Belousov 		if (g_handleattr_int(bp, "GEOM::candelete",
469d91e813cSKonstantin Belousov 		    (dp->d_flags & DISKFLAG_CANDELETE) != 0))
470d91e813cSKonstantin Belousov 			break;
471d91e813cSKonstantin Belousov 		else if (g_handleattr_int(bp, "GEOM::fwsectors",
472d91e813cSKonstantin Belousov 		    dp->d_fwsectors))
473a5b2e75dSPoul-Henning Kamp 			break;
4747812d86fSPoul-Henning Kamp 		else if (g_handleattr_int(bp, "GEOM::fwheads", dp->d_fwheads))
475a5b2e75dSPoul-Henning Kamp 			break;
476503abe45SPoul-Henning Kamp 		else if (g_handleattr_off_t(bp, "GEOM::frontstuff", 0))
4771bdb20a6SPoul-Henning Kamp 			break;
478d0c11f9eSPawel Jakub Dawidek 		else if (g_handleattr_str(bp, "GEOM::ident", dp->d_ident))
479d0c11f9eSPawel Jakub Dawidek 			break;
480c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_vendor",
481c28078e9SSteven Hartland 		    dp->d_hba_vendor))
4828edcf694SAlexander Motin 			break;
483c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_device",
484c28078e9SSteven Hartland 		    dp->d_hba_device))
4858edcf694SAlexander Motin 			break;
486c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_subvendor",
487c28078e9SSteven Hartland 		    dp->d_hba_subvendor))
4888edcf694SAlexander Motin 			break;
489c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::hba_subdevice",
490c28078e9SSteven Hartland 		    dp->d_hba_subdevice))
4918edcf694SAlexander Motin 			break;
49295c24b31SPoul-Henning Kamp 		else if (!strcmp(bp->bio_attribute, "GEOM::kerneldump"))
49395c24b31SPoul-Henning Kamp 			g_disk_kerneldump(bp, dp);
494c6d4ed3aSAlexander Motin 		else if (!strcmp(bp->bio_attribute, "GEOM::setstate"))
495c6d4ed3aSAlexander Motin 			g_disk_setstate(bp, sc);
496c28078e9SSteven Hartland 		else if (g_handleattr_uint16_t(bp, "GEOM::rotation_rate",
497c28078e9SSteven Hartland 		    dp->d_rotation_rate))
498c28078e9SSteven Hartland 			break;
499497c3347SPoul-Henning Kamp 		else
500a5b2e75dSPoul-Henning Kamp 			error = ENOIOCTL;
501a5b2e75dSPoul-Henning Kamp 		break;
5021d2aee20SPawel Jakub Dawidek 	case BIO_FLUSH:
50385f5b9aaSAndriy Gapon 		g_trace(G_T_BIO, "g_disk_flushcache(%s)",
5041d2aee20SPawel Jakub Dawidek 		    bp->bio_to->name);
5051d2aee20SPawel Jakub Dawidek 		if (!(dp->d_flags & DISKFLAG_CANFLUSHCACHE)) {
50692f84a9fSPawel Jakub Dawidek 			error = EOPNOTSUPP;
50792f84a9fSPawel Jakub Dawidek 			break;
5081d2aee20SPawel Jakub Dawidek 		}
509ccf8a568SAlexander Motin 		bp2 = g_clone_bio(bp);
510ccf8a568SAlexander Motin 		if (bp2 == NULL) {
511ccf8a568SAlexander Motin 			g_io_deliver(bp, ENOMEM);
512ccf8a568SAlexander Motin 			return;
513ccf8a568SAlexander Motin 		}
514ccf8a568SAlexander Motin 		bp2->bio_done = g_disk_done;
515ccf8a568SAlexander Motin 		bp2->bio_disk = dp;
516413037c8SAlexander Motin 		mtx_lock(&sc->start_mtx);
517ccf8a568SAlexander Motin 		devstat_start_transaction_bio(dp->d_devstat, bp2);
518413037c8SAlexander Motin 		mtx_unlock(&sc->start_mtx);
519ccf8a568SAlexander Motin 		dp->d_strategy(bp2);
5201d2aee20SPawel Jakub Dawidek 		break;
521dd84a43cSPoul-Henning Kamp 	default:
522a5b2e75dSPoul-Henning Kamp 		error = EOPNOTSUPP;
523a5b2e75dSPoul-Henning Kamp 		break;
524dd84a43cSPoul-Henning Kamp 	}
525b362694cSPoul-Henning Kamp 	if (error != EJUSTRETURN)
52672840432SPoul-Henning Kamp 		g_io_deliver(bp, error);
527a5b2e75dSPoul-Henning Kamp 	return;
528dd84a43cSPoul-Henning Kamp }
529dd84a43cSPoul-Henning Kamp 
5308523987bSPoul-Henning Kamp static void
5310f9d3dbaSPoul-Henning Kamp g_disk_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp, struct g_provider *pp)
5328f9628a1SPoul-Henning Kamp {
533ccba7102SAlexander Motin 	struct bio *bp;
5348f9628a1SPoul-Henning Kamp 	struct disk *dp;
535c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
536ccba7102SAlexander Motin 	char *buf;
537ccba7102SAlexander Motin 	int res = 0;
5388f9628a1SPoul-Henning Kamp 
539c6d4ed3aSAlexander Motin 	sc = gp->softc;
540c6d4ed3aSAlexander Motin 	if (sc == NULL || (dp = sc->dp) == NULL)
541eb98005fSPoul-Henning Kamp 		return;
542d518e539SPoul-Henning Kamp 	if (indent == NULL) {
543d518e539SPoul-Henning Kamp 		sbuf_printf(sb, " hd %u", dp->d_fwheads);
544d518e539SPoul-Henning Kamp 		sbuf_printf(sb, " sc %u", dp->d_fwsectors);
545d518e539SPoul-Henning Kamp 		return;
546d518e539SPoul-Henning Kamp 	}
5479e2ebaa0SPoul-Henning Kamp 	if (pp != NULL) {
5488f9628a1SPoul-Henning Kamp 		sbuf_printf(sb, "%s<fwheads>%u</fwheads>\n",
5498f9628a1SPoul-Henning Kamp 		    indent, dp->d_fwheads);
5508f9628a1SPoul-Henning Kamp 		sbuf_printf(sb, "%s<fwsectors>%u</fwsectors>\n",
5518f9628a1SPoul-Henning Kamp 		    indent, dp->d_fwsectors);
552*cb03a502SRavi Pokala 
553*cb03a502SRavi Pokala 		/*
554*cb03a502SRavi Pokala 		 * "rotationrate" is a little complicated, because the value
555*cb03a502SRavi Pokala 		 * returned by the drive might not be the RPM; 0 and 1 are
556*cb03a502SRavi Pokala 		 * special cases, and there's also a valid range.
557*cb03a502SRavi Pokala 		 */
558*cb03a502SRavi Pokala 		sbuf_printf(sb, "%s<rotationrate>", indent);
559*cb03a502SRavi Pokala 		if (dp->d_rotation_rate == 0)		/* Old drives don't */
560*cb03a502SRavi Pokala 			sbuf_printf(sb, "unknown");	/* report RPM. */
561*cb03a502SRavi Pokala 		else if (dp->d_rotation_rate == 1)	/* Since 0 is used */
562*cb03a502SRavi Pokala 			sbuf_printf(sb, "0");		/* above, SSDs use 1. */
563*cb03a502SRavi Pokala 		else if ((dp->d_rotation_rate >= 0x041) &&
564*cb03a502SRavi Pokala 		    (dp->d_rotation_rate <= 0xfffe))
565*cb03a502SRavi Pokala 			sbuf_printf(sb, "%u", dp->d_rotation_rate);
566*cb03a502SRavi Pokala 		else
567*cb03a502SRavi Pokala 			sbuf_printf(sb, "invalid");
568*cb03a502SRavi Pokala 		sbuf_printf(sb, "</rotationrate>\n");
569ccba7102SAlexander Motin 		if (dp->d_getattr != NULL) {
570ccba7102SAlexander Motin 			buf = g_malloc(DISK_IDENT_SIZE, M_WAITOK);
571ccba7102SAlexander Motin 			bp = g_alloc_bio();
572ccba7102SAlexander Motin 			bp->bio_disk = dp;
573ccba7102SAlexander Motin 			bp->bio_attribute = "GEOM::ident";
574ccba7102SAlexander Motin 			bp->bio_length = DISK_IDENT_SIZE;
575ccba7102SAlexander Motin 			bp->bio_data = buf;
576ccba7102SAlexander Motin 			res = dp->d_getattr(bp);
5777ae1a87bSAlexander Motin 			sbuf_printf(sb, "%s<ident>", indent);
5787ae1a87bSAlexander Motin 			g_conf_printf_escaped(sb, "%s",
579ccba7102SAlexander Motin 			    res == 0 ? buf: dp->d_ident);
5807ae1a87bSAlexander Motin 			sbuf_printf(sb, "</ident>\n");
581ccba7102SAlexander Motin 			bp->bio_attribute = "GEOM::lunid";
582ccba7102SAlexander Motin 			bp->bio_length = DISK_IDENT_SIZE;
583ccba7102SAlexander Motin 			bp->bio_data = buf;
5847ae1a87bSAlexander Motin 			if (dp->d_getattr(bp) == 0) {
5857ae1a87bSAlexander Motin 				sbuf_printf(sb, "%s<lunid>", indent);
5867ae1a87bSAlexander Motin 				g_conf_printf_escaped(sb, "%s", buf);
5877ae1a87bSAlexander Motin 				sbuf_printf(sb, "</lunid>\n");
5887ae1a87bSAlexander Motin 			}
58940f27d7cSAlexander Motin 			bp->bio_attribute = "GEOM::lunname";
59040f27d7cSAlexander Motin 			bp->bio_length = DISK_IDENT_SIZE;
59140f27d7cSAlexander Motin 			bp->bio_data = buf;
5927ae1a87bSAlexander Motin 			if (dp->d_getattr(bp) == 0) {
5937ae1a87bSAlexander Motin 				sbuf_printf(sb, "%s<lunname>", indent);
5947ae1a87bSAlexander Motin 				g_conf_printf_escaped(sb, "%s", buf);
5957ae1a87bSAlexander Motin 				sbuf_printf(sb, "</lunname>\n");
5967ae1a87bSAlexander Motin 			}
597ccba7102SAlexander Motin 			g_destroy_bio(bp);
598ccba7102SAlexander Motin 			g_free(buf);
5997ae1a87bSAlexander Motin 		} else {
6007ae1a87bSAlexander Motin 			sbuf_printf(sb, "%s<ident>", indent);
6017ae1a87bSAlexander Motin 			g_conf_printf_escaped(sb, "%s", dp->d_ident);
6027ae1a87bSAlexander Motin 			sbuf_printf(sb, "</ident>\n");
6037ae1a87bSAlexander Motin 		}
6047ae1a87bSAlexander Motin 		sbuf_printf(sb, "%s<descr>", indent);
6057ae1a87bSAlexander Motin 		g_conf_printf_escaped(sb, "%s", dp->d_descr);
6067ae1a87bSAlexander Motin 		sbuf_printf(sb, "</descr>\n");
6078f9628a1SPoul-Henning Kamp 	}
6088f9628a1SPoul-Henning Kamp }
6098f9628a1SPoul-Henning Kamp 
6108f9628a1SPoul-Henning Kamp static void
6111af2d09bSEdward Tomasz Napierala g_disk_resize(void *ptr, int flag)
612bc97ce36SEdward Tomasz Napierala {
6131af2d09bSEdward Tomasz Napierala 	struct disk *dp;
614bc97ce36SEdward Tomasz Napierala 	struct g_geom *gp;
615bc97ce36SEdward Tomasz Napierala 	struct g_provider *pp;
616bc97ce36SEdward Tomasz Napierala 
6171af2d09bSEdward Tomasz Napierala 	if (flag == EV_CANCEL)
6181af2d09bSEdward Tomasz Napierala 		return;
6191af2d09bSEdward Tomasz Napierala 	g_topology_assert();
6201af2d09bSEdward Tomasz Napierala 
6211af2d09bSEdward Tomasz Napierala 	dp = ptr;
622bc97ce36SEdward Tomasz Napierala 	gp = dp->d_geom;
623bc97ce36SEdward Tomasz Napierala 
6241af2d09bSEdward Tomasz Napierala 	if (dp->d_destroyed || gp == NULL)
6251af2d09bSEdward Tomasz Napierala 		return;
6261af2d09bSEdward Tomasz Napierala 
627bc97ce36SEdward Tomasz Napierala 	LIST_FOREACH(pp, &gp->provider, provider) {
628bc97ce36SEdward Tomasz Napierala 		if (pp->sectorsize != 0 &&
629bc97ce36SEdward Tomasz Napierala 		    pp->sectorsize != dp->d_sectorsize)
630bc97ce36SEdward Tomasz Napierala 			g_wither_provider(pp, ENXIO);
631bc97ce36SEdward Tomasz Napierala 		else
632bc97ce36SEdward Tomasz Napierala 			g_resize_provider(pp, dp->d_mediasize);
633bc97ce36SEdward Tomasz Napierala 	}
634bc97ce36SEdward Tomasz Napierala }
635bc97ce36SEdward Tomasz Napierala 
636bc97ce36SEdward Tomasz Napierala static void
63743f0db6cSPoul-Henning Kamp g_disk_create(void *arg, int flag)
638dd84a43cSPoul-Henning Kamp {
639dd84a43cSPoul-Henning Kamp 	struct g_geom *gp;
640dd84a43cSPoul-Henning Kamp 	struct g_provider *pp;
641bb17c5f6SPoul-Henning Kamp 	struct disk *dp;
642c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
643c6d4ed3aSAlexander Motin 	char tmpstr[80];
644dd84a43cSPoul-Henning Kamp 
64543f0db6cSPoul-Henning Kamp 	if (flag == EV_CANCEL)
64643f0db6cSPoul-Henning Kamp 		return;
6478523987bSPoul-Henning Kamp 	g_topology_assert();
648bb17c5f6SPoul-Henning Kamp 	dp = arg;
649c6d4ed3aSAlexander Motin 	sc = g_malloc(sizeof(*sc), M_WAITOK | M_ZERO);
65040ea77a0SAlexander Motin 	mtx_init(&sc->start_mtx, "g_disk_start", NULL, MTX_DEF);
65130ba7471SAlexander Motin 	mtx_init(&sc->done_mtx, "g_disk_done", NULL, MTX_DEF);
652c6d4ed3aSAlexander Motin 	sc->dp = dp;
653bb17c5f6SPoul-Henning Kamp 	gp = g_new_geomf(&g_disk_class, "%s%d", dp->d_name, dp->d_unit);
654c6d4ed3aSAlexander Motin 	gp->softc = sc;
6558523987bSPoul-Henning Kamp 	pp = g_new_providerf(gp, "%s", gp->name);
65640ea77a0SAlexander Motin 	devstat_remove_entry(pp->stat);
65740ea77a0SAlexander Motin 	pp->stat = NULL;
65840ea77a0SAlexander Motin 	dp->d_devstat->id = pp;
659bb17c5f6SPoul-Henning Kamp 	pp->mediasize = dp->d_mediasize;
660bb17c5f6SPoul-Henning Kamp 	pp->sectorsize = dp->d_sectorsize;
6618a63edc3SPoul-Henning Kamp 	pp->stripeoffset = dp->d_stripeoffset;
6628a63edc3SPoul-Henning Kamp 	pp->stripesize = dp->d_stripesize;
663f8c19ba4SKonstantin Belousov 	if ((dp->d_flags & DISKFLAG_UNMAPPED_BIO) != 0)
664f8c19ba4SKonstantin Belousov 		pp->flags |= G_PF_ACCEPT_UNMAPPED;
66540ea77a0SAlexander Motin 	if ((dp->d_flags & DISKFLAG_DIRECT_COMPLETION) != 0)
66640ea77a0SAlexander Motin 		pp->flags |= G_PF_DIRECT_SEND;
66740ea77a0SAlexander Motin 	pp->flags |= G_PF_DIRECT_RECEIVE;
6683d5500fcSPoul-Henning Kamp 	if (bootverbose)
6693d5500fcSPoul-Henning Kamp 		printf("GEOM: new disk %s\n", gp->name);
670c6d4ed3aSAlexander Motin 	sysctl_ctx_init(&sc->sysctl_ctx);
671c6d4ed3aSAlexander Motin 	snprintf(tmpstr, sizeof(tmpstr), "GEOM disk %s", gp->name);
672c6d4ed3aSAlexander Motin 	sc->sysctl_tree = SYSCTL_ADD_NODE(&sc->sysctl_ctx,
673c6d4ed3aSAlexander Motin 		SYSCTL_STATIC_CHILDREN(_kern_geom_disk), OID_AUTO, gp->name,
674c6d4ed3aSAlexander Motin 		CTLFLAG_RD, 0, tmpstr);
675c6d4ed3aSAlexander Motin 	if (sc->sysctl_tree != NULL) {
676c6d4ed3aSAlexander Motin 		SYSCTL_ADD_STRING(&sc->sysctl_ctx,
677c6d4ed3aSAlexander Motin 		    SYSCTL_CHILDREN(sc->sysctl_tree), OID_AUTO, "led",
678af3b2549SHans Petter Selasky 		    CTLFLAG_RWTUN, sc->led, sizeof(sc->led),
679c6d4ed3aSAlexander Motin 		    "LED name");
680c6d4ed3aSAlexander Motin 	}
681c6d4ed3aSAlexander Motin 	pp->private = sc;
682316aed03SPoul-Henning Kamp 	dp->d_geom = gp;
683316aed03SPoul-Henning Kamp 	g_error_provider(pp, 0);
684dd84a43cSPoul-Henning Kamp }
6858523987bSPoul-Henning Kamp 
686c3fb2891SKenneth D. Merry /*
687c3fb2891SKenneth D. Merry  * We get this callback after all of the consumers have gone away, and just
688c3fb2891SKenneth D. Merry  * before the provider is freed.  If the disk driver provided a d_gone
689c3fb2891SKenneth D. Merry  * callback, let them know that it is okay to free resources -- they won't
690c3fb2891SKenneth D. Merry  * be getting any more accesses from GEOM.
691c3fb2891SKenneth D. Merry  */
692c3fb2891SKenneth D. Merry static void
693c3fb2891SKenneth D. Merry g_disk_providergone(struct g_provider *pp)
694c3fb2891SKenneth D. Merry {
695c3fb2891SKenneth D. Merry 	struct disk *dp;
696c3fb2891SKenneth D. Merry 	struct g_disk_softc *sc;
697c3fb2891SKenneth D. Merry 
69830ba7471SAlexander Motin 	sc = (struct g_disk_softc *)pp->private;
699c3fb2891SKenneth D. Merry 	dp = sc->dp;
70030ba7471SAlexander Motin 	if (dp != NULL && dp->d_gone != NULL)
701c3fb2891SKenneth D. Merry 		dp->d_gone(dp);
70230ba7471SAlexander Motin 	if (sc->sysctl_tree != NULL) {
70330ba7471SAlexander Motin 		sysctl_ctx_free(&sc->sysctl_ctx);
70430ba7471SAlexander Motin 		sc->sysctl_tree = NULL;
70530ba7471SAlexander Motin 	}
70630ba7471SAlexander Motin 	if (sc->led[0] != 0) {
70730ba7471SAlexander Motin 		led_set(sc->led, "0");
70830ba7471SAlexander Motin 		sc->led[0] = 0;
70930ba7471SAlexander Motin 	}
71030ba7471SAlexander Motin 	pp->private = NULL;
71130ba7471SAlexander Motin 	pp->geom->softc = NULL;
71230ba7471SAlexander Motin 	mtx_destroy(&sc->done_mtx);
71340ea77a0SAlexander Motin 	mtx_destroy(&sc->start_mtx);
71430ba7471SAlexander Motin 	g_free(sc);
715c3fb2891SKenneth D. Merry }
716c3fb2891SKenneth D. Merry 
717ce1ee789SPoul-Henning Kamp static void
718ce1ee789SPoul-Henning Kamp g_disk_destroy(void *ptr, int flag)
719ce1ee789SPoul-Henning Kamp {
7200b7ed341SPoul-Henning Kamp 	struct disk *dp;
721ce1ee789SPoul-Henning Kamp 	struct g_geom *gp;
722c6d4ed3aSAlexander Motin 	struct g_disk_softc *sc;
7238523987bSPoul-Henning Kamp 
724ce1ee789SPoul-Henning Kamp 	g_topology_assert();
7250b7ed341SPoul-Henning Kamp 	dp = ptr;
7260b7ed341SPoul-Henning Kamp 	gp = dp->d_geom;
727032bc81dSPoul-Henning Kamp 	if (gp != NULL) {
728c6d4ed3aSAlexander Motin 		sc = gp->softc;
72930ba7471SAlexander Motin 		if (sc != NULL)
73030ba7471SAlexander Motin 			sc->dp = NULL;
73130ba7471SAlexander Motin 		dp->d_geom = NULL;
732ce1ee789SPoul-Henning Kamp 		g_wither_geom(gp, ENXIO);
733032bc81dSPoul-Henning Kamp 	}
7340b7ed341SPoul-Henning Kamp 	g_free(dp);
7350b7ed341SPoul-Henning Kamp }
7360b7ed341SPoul-Henning Kamp 
7375e16a486SPawel Jakub Dawidek /*
738e93f5e4dSPawel Jakub Dawidek  * We only allow printable characters in disk ident,
739e93f5e4dSPawel Jakub Dawidek  * the rest is converted to 'x<HH>'.
7405e16a486SPawel Jakub Dawidek  */
7415e16a486SPawel Jakub Dawidek static void
7425e16a486SPawel Jakub Dawidek g_disk_ident_adjust(char *ident, size_t size)
7435e16a486SPawel Jakub Dawidek {
744e93f5e4dSPawel Jakub Dawidek 	char *p, tmp[4], newid[DISK_IDENT_SIZE];
7455e16a486SPawel Jakub Dawidek 
746e93f5e4dSPawel Jakub Dawidek 	newid[0] = '\0';
747e93f5e4dSPawel Jakub Dawidek 	for (p = ident; *p != '\0'; p++) {
748e93f5e4dSPawel Jakub Dawidek 		if (isprint(*p)) {
749e93f5e4dSPawel Jakub Dawidek 			tmp[0] = *p;
750e93f5e4dSPawel Jakub Dawidek 			tmp[1] = '\0';
751e93f5e4dSPawel Jakub Dawidek 		} else {
752e93f5e4dSPawel Jakub Dawidek 			snprintf(tmp, sizeof(tmp), "x%02hhx",
753e93f5e4dSPawel Jakub Dawidek 			    *(unsigned char *)p);
7545e16a486SPawel Jakub Dawidek 		}
755e93f5e4dSPawel Jakub Dawidek 		if (strlcat(newid, tmp, sizeof(newid)) >= sizeof(newid))
7565e16a486SPawel Jakub Dawidek 			break;
7575e16a486SPawel Jakub Dawidek 	}
7585e16a486SPawel Jakub Dawidek 	bzero(ident, size);
7595e16a486SPawel Jakub Dawidek 	strlcpy(ident, newid, size);
7605e16a486SPawel Jakub Dawidek }
7615e16a486SPawel Jakub Dawidek 
7620b7ed341SPoul-Henning Kamp struct disk *
76394954762SPawel Jakub Dawidek disk_alloc(void)
7640b7ed341SPoul-Henning Kamp {
7650b7ed341SPoul-Henning Kamp 
76694954762SPawel Jakub Dawidek 	return (g_malloc(sizeof(struct disk), M_WAITOK | M_ZERO));
767ce1ee789SPoul-Henning Kamp }
7688523987bSPoul-Henning Kamp 
76998bbd7aaSPoul-Henning Kamp void
7700b7ed341SPoul-Henning Kamp disk_create(struct disk *dp, int version)
7718523987bSPoul-Henning Kamp {
77237f0f0a7SPawel Jakub Dawidek 
7738383a92eSSteven Hartland 	if (version != DISK_VERSION) {
7740b7ed341SPoul-Henning Kamp 		printf("WARNING: Attempt to add disk %s%d %s",
7750b7ed341SPoul-Henning Kamp 		    dp->d_name, dp->d_unit,
7760b7ed341SPoul-Henning Kamp 		    " using incompatible ABI version of disk(9)\n");
7770b7ed341SPoul-Henning Kamp 		printf("WARNING: Ignoring disk %s%d\n",
7780b7ed341SPoul-Henning Kamp 		    dp->d_name, dp->d_unit);
7790b7ed341SPoul-Henning Kamp 		return;
7800b7ed341SPoul-Henning Kamp 	}
781d6d78db5SJohn Baldwin 	if (dp->d_flags & DISKFLAG_RESERVED) {
782d6d78db5SJohn Baldwin 		printf("WARNING: Attempt to add non-MPSAFE disk %s%d\n",
783d6d78db5SJohn Baldwin 		    dp->d_name, dp->d_unit);
784d6d78db5SJohn Baldwin 		printf("WARNING: Ignoring disk %s%d\n",
785d6d78db5SJohn Baldwin 		    dp->d_name, dp->d_unit);
786d6d78db5SJohn Baldwin 		return;
787d6d78db5SJohn Baldwin 	}
78831a1093fSPoul-Henning Kamp 	KASSERT(dp->d_strategy != NULL, ("disk_create need d_strategy"));
78931a1093fSPoul-Henning Kamp 	KASSERT(dp->d_name != NULL, ("disk_create need d_name"));
79031a1093fSPoul-Henning Kamp 	KASSERT(*dp->d_name != 0, ("disk_create need d_name"));
791237d2765SPoul-Henning Kamp 	KASSERT(strlen(dp->d_name) < SPECNAMELEN - 4, ("disk name too long"));
792eb98005fSPoul-Henning Kamp 	if (dp->d_devstat == NULL)
79309f95804SPoul-Henning Kamp 		dp->d_devstat = devstat_new_entry(dp->d_name, dp->d_unit,
79460794e04SPoul-Henning Kamp 		    dp->d_sectorsize, DEVSTAT_ALL_SUPPORTED,
79560794e04SPoul-Henning Kamp 		    DEVSTAT_TYPE_DIRECT, DEVSTAT_PRIORITY_MAX);
796316aed03SPoul-Henning Kamp 	dp->d_geom = NULL;
7975e16a486SPawel Jakub Dawidek 	g_disk_ident_adjust(dp->d_ident, sizeof(dp->d_ident));
7988cd1535aSPoul-Henning Kamp 	g_post_event(g_disk_create, dp, M_WAITOK, dp, NULL);
799dd84a43cSPoul-Henning Kamp }
800dd84a43cSPoul-Henning Kamp 
801dd84a43cSPoul-Henning Kamp void
802b82ff758SPoul-Henning Kamp disk_destroy(struct disk *dp)
803dd84a43cSPoul-Henning Kamp {
804dd84a43cSPoul-Henning Kamp 
805316aed03SPoul-Henning Kamp 	g_cancel_event(dp);
8060b7ed341SPoul-Henning Kamp 	dp->d_destroyed = 1;
80752c583feSPoul-Henning Kamp 	if (dp->d_devstat != NULL)
80852c583feSPoul-Henning Kamp 		devstat_remove_entry(dp->d_devstat);
80911e9a679SPoul-Henning Kamp 	g_post_event(g_disk_destroy, dp, M_WAITOK, NULL);
810dd84a43cSPoul-Henning Kamp }
811dd84a43cSPoul-Henning Kamp 
812a7e69e8bSJohn Polstra void
813a7e69e8bSJohn Polstra disk_gone(struct disk *dp)
814a7e69e8bSJohn Polstra {
815a7e69e8bSJohn Polstra 	struct g_geom *gp;
816a7e69e8bSJohn Polstra 	struct g_provider *pp;
817a7e69e8bSJohn Polstra 
818a7e69e8bSJohn Polstra 	gp = dp->d_geom;
819171f6b3aSPawel Jakub Dawidek 	if (gp != NULL) {
8205d8a6a10SPawel Jakub Dawidek 		pp = LIST_FIRST(&gp->provider);
8215d8a6a10SPawel Jakub Dawidek 		if (pp != NULL) {
8225d8a6a10SPawel Jakub Dawidek 			KASSERT(LIST_NEXT(pp, provider) == NULL,
8235d8a6a10SPawel Jakub Dawidek 			    ("geom %p has more than one provider", gp));
824d99c1559SMarcel Moolenaar 			g_wither_provider(pp, ENXIO);
825a7e69e8bSJohn Polstra 		}
8265d8a6a10SPawel Jakub Dawidek 	}
827171f6b3aSPawel Jakub Dawidek }
828a7e69e8bSJohn Polstra 
829416494d7SJustin T. Gibbs void
830416494d7SJustin T. Gibbs disk_attr_changed(struct disk *dp, const char *attr, int flag)
831416494d7SJustin T. Gibbs {
832416494d7SJustin T. Gibbs 	struct g_geom *gp;
833416494d7SJustin T. Gibbs 	struct g_provider *pp;
834416494d7SJustin T. Gibbs 
835416494d7SJustin T. Gibbs 	gp = dp->d_geom;
836416494d7SJustin T. Gibbs 	if (gp != NULL)
837416494d7SJustin T. Gibbs 		LIST_FOREACH(pp, &gp->provider, provider)
838416494d7SJustin T. Gibbs 			(void)g_attr_changed(pp, attr, flag);
839416494d7SJustin T. Gibbs }
840416494d7SJustin T. Gibbs 
841bc97ce36SEdward Tomasz Napierala void
8423631c638SAlexander Motin disk_media_changed(struct disk *dp, int flag)
8433631c638SAlexander Motin {
8443631c638SAlexander Motin 	struct g_geom *gp;
8453631c638SAlexander Motin 	struct g_provider *pp;
8463631c638SAlexander Motin 
8473631c638SAlexander Motin 	gp = dp->d_geom;
8483631c638SAlexander Motin 	if (gp != NULL) {
8490fb832fdSAlexander Motin 		pp = LIST_FIRST(&gp->provider);
8500fb832fdSAlexander Motin 		if (pp != NULL) {
8510fb832fdSAlexander Motin 			KASSERT(LIST_NEXT(pp, provider) == NULL,
8520fb832fdSAlexander Motin 			    ("geom %p has more than one provider", gp));
8533631c638SAlexander Motin 			g_media_changed(pp, flag);
8543631c638SAlexander Motin 		}
8553631c638SAlexander Motin 	}
8560fb832fdSAlexander Motin }
8573631c638SAlexander Motin 
8583631c638SAlexander Motin void
8593631c638SAlexander Motin disk_media_gone(struct disk *dp, int flag)
8603631c638SAlexander Motin {
8613631c638SAlexander Motin 	struct g_geom *gp;
8623631c638SAlexander Motin 	struct g_provider *pp;
8633631c638SAlexander Motin 
8643631c638SAlexander Motin 	gp = dp->d_geom;
8653631c638SAlexander Motin 	if (gp != NULL) {
8660fb832fdSAlexander Motin 		pp = LIST_FIRST(&gp->provider);
8670fb832fdSAlexander Motin 		if (pp != NULL) {
8680fb832fdSAlexander Motin 			KASSERT(LIST_NEXT(pp, provider) == NULL,
8690fb832fdSAlexander Motin 			    ("geom %p has more than one provider", gp));
8703631c638SAlexander Motin 			g_media_gone(pp, flag);
8713631c638SAlexander Motin 		}
8723631c638SAlexander Motin 	}
8730fb832fdSAlexander Motin }
8743631c638SAlexander Motin 
8751af2d09bSEdward Tomasz Napierala int
8761af2d09bSEdward Tomasz Napierala disk_resize(struct disk *dp, int flag)
877bc97ce36SEdward Tomasz Napierala {
878bc97ce36SEdward Tomasz Napierala 
8791af2d09bSEdward Tomasz Napierala 	if (dp->d_destroyed || dp->d_geom == NULL)
8801af2d09bSEdward Tomasz Napierala 		return (0);
881bc97ce36SEdward Tomasz Napierala 
8821af2d09bSEdward Tomasz Napierala 	return (g_post_event(g_disk_resize, dp, flag, NULL));
883bc97ce36SEdward Tomasz Napierala }
884bc97ce36SEdward Tomasz Napierala 
8850cc3011dSPoul-Henning Kamp static void
886afcbcfaeSPoul-Henning Kamp g_kern_disks(void *p, int flag __unused)
8870cc3011dSPoul-Henning Kamp {
8880cc3011dSPoul-Henning Kamp 	struct sbuf *sb;
8890cc3011dSPoul-Henning Kamp 	struct g_geom *gp;
8900cc3011dSPoul-Henning Kamp 	char *sp;
8910cc3011dSPoul-Henning Kamp 
8920cc3011dSPoul-Henning Kamp 	sb = p;
8930cc3011dSPoul-Henning Kamp 	sp = "";
8940cc3011dSPoul-Henning Kamp 	g_topology_assert();
8950cc3011dSPoul-Henning Kamp 	LIST_FOREACH(gp, &g_disk_class.geom, geom) {
8960cc3011dSPoul-Henning Kamp 		sbuf_printf(sb, "%s%s", sp, gp->name);
8970cc3011dSPoul-Henning Kamp 		sp = " ";
8980cc3011dSPoul-Henning Kamp 	}
8990cc3011dSPoul-Henning Kamp 	sbuf_finish(sb);
9000cc3011dSPoul-Henning Kamp }
9010cc3011dSPoul-Henning Kamp 
9020cc3011dSPoul-Henning Kamp static int
9030cc3011dSPoul-Henning Kamp sysctl_disks(SYSCTL_HANDLER_ARGS)
9040cc3011dSPoul-Henning Kamp {
9050cc3011dSPoul-Henning Kamp 	int error;
9060cc3011dSPoul-Henning Kamp 	struct sbuf *sb;
9070cc3011dSPoul-Henning Kamp 
9082616144eSDag-Erling Smørgrav 	sb = sbuf_new_auto();
9090a9c130cSPoul-Henning Kamp 	g_waitfor_event(g_kern_disks, sb, M_WAITOK, NULL);
910aed99af2SPoul-Henning Kamp 	error = SYSCTL_OUT(req, sbuf_data(sb), sbuf_len(sb) + 1);
9110cc3011dSPoul-Henning Kamp 	sbuf_delete(sb);
9120cc3011dSPoul-Henning Kamp 	return error;
9130cc3011dSPoul-Henning Kamp }
9140cc3011dSPoul-Henning Kamp 
91573d6f851SMatthew D Fleming SYSCTL_PROC(_kern, OID_AUTO, disks,
91673d6f851SMatthew D Fleming     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0,
9170cc3011dSPoul-Henning Kamp     sysctl_disks, "A", "names of available disks");
918