2 * Copyright (c) 2002 Poul-Henning Kamp
3 * Copyright (c) 2002 Networks Associates Technology, Inc.
6 * This software was developed for the FreeBSD Project by Poul-Henning Kamp
7 * and NAI Labs, the Security Research Division of Network Associates, Inc.
8 * under DARPA/SPAWAR contract N66001-01-C-8035 ("CBOSS"), as part of the
9 * DARPA CHATS research program.
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
14 * 1. Redistributions of source code must retain the above copyright
15 * notice, this list of conditions and the following disclaimer.
16 * 2. Redistributions in binary form must reproduce the above copyright
17 * notice, this list of conditions and the following disclaimer in the
18 * documentation and/or other materials provided with the distribution.
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 #include <sys/cdefs.h>
34 __FBSDID("$FreeBSD$");
36 #include <sys/param.h>
37 #include <sys/errno.h>
38 #include <sys/endian.h>
39 #include <sys/systm.h>
40 #include <sys/kernel.h>
41 #include <sys/fcntl.h>
42 #include <sys/malloc.h>
45 #include <sys/mutex.h>
48 #include <sys/diskmbr.h>
50 #include <geom/geom.h>
51 #include <geom/geom_slice.h>
53 #define MBR_CLASS_NAME "MBR"
54 #define MBREXT_CLASS_NAME "MBREXT"
56 static struct dos_partition historical_bogus_partition_table[NDOSPART] = {
57 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, },
58 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, },
59 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, },
60 { 0x80, 0, 1, 0, DOSPTYP_386BSD, 255, 255, 255, 0, 50000, },
63 static struct dos_partition historical_bogus_partition_table_fixed[NDOSPART] = {
64 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, },
65 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, },
66 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, },
67 { 0x80, 0, 1, 0, DOSPTYP_386BSD, 254, 255, 255, 0, 50000, },
71 g_mbr_print(int i, struct dos_partition *dp)
74 printf("[%d] f:%02x typ:%d", i, dp->dp_flag, dp->dp_typ);
75 printf(" s(CHS):%d/%d/%d", DPCYL(dp->dp_scyl, dp->dp_ssect),
76 dp->dp_shd, DPSECT(dp->dp_ssect));
77 printf(" e(CHS):%d/%d/%d", DPCYL(dp->dp_ecyl, dp->dp_esect),
78 dp->dp_ehd, DPSECT(dp->dp_esect));
79 printf(" s:%d l:%d\n", dp->dp_start, dp->dp_size);
90 * XXX: Add gctl_req arg and give good error msgs.
91 * XXX: Check that length argument does not bring boot code inside any slice.
94 g_mbr_modify(struct g_geom *gp, struct g_mbr_softc *ms, u_char *sec0, int len __unused)
98 struct dos_partition ndp[NDOSPART], *dp;
103 if (sec0[0x1fe] != 0x55 && sec0[0x1ff] != 0xaa)
107 for (i = 0; i < NDOSPART; i++) {
109 sec0 + DOSPARTOFF + i * sizeof(struct dos_partition),
112 if ((!bcmp(dp, historical_bogus_partition_table,
113 sizeof historical_bogus_partition_table)) ||
114 (!bcmp(dp, historical_bogus_partition_table_fixed,
115 sizeof historical_bogus_partition_table_fixed))) {
117 * We will not allow people to write these from "the inside",
118 * Since properly selfdestructing takes too much code. If
119 * people really want to do this, they cannot have any
120 * providers of this geom open, and in that case they can just
121 * as easily overwrite the MBR in the parent device.
125 for (i = 0; i < NDOSPART; i++) {
127 * A Protective MBR (PMBR) has a single partition of
128 * type 0xEE spanning the whole disk. Such a MBR
129 * protects a GPT on the disk from MBR tools that
130 * don't know anything about GPT. We're interpreting
131 * it a bit more loosely: any partition of type 0xEE
132 * is to be skipped as it doesn't contain any data
133 * that we should care about. We still allow other
134 * partitions to be present in the MBR. A PMBR will
135 * be handled correctly anyway.
137 if (dp[i].dp_typ == DOSPTYP_PMBR)
139 else if (dp[i].dp_flag != 0 && dp[i].dp_flag != 0x80)
141 else if (dp[i].dp_typ == 0)
144 l[i] = (off_t)dp[i].dp_size * ms->sectorsize;
145 error = g_slice_config(gp, i, G_SLICE_CONFIG_CHECK,
146 (off_t)dp[i].dp_start * ms->sectorsize, l[i],
147 ms->sectorsize, "%ss%d", gp->name, 1 + i);
151 for (i = 0; i < NDOSPART; i++) {
152 ms->type[i] = dp[i].dp_typ;
153 g_slice_config(gp, i, G_SLICE_CONFIG_SET,
154 (off_t)dp[i].dp_start * ms->sectorsize, l[i],
155 ms->sectorsize, "%ss%d", gp->name, 1 + i);
157 bcopy(sec0, ms->sec0, 512);
160 * Calculate MD5 from the first sector and use it for avoiding
161 * recursive slices creation.
164 MD5Update(&md5sum, ms->sec0, sizeof(ms->sec0));
165 MD5Final(ms->slicesum, &md5sum);
171 g_mbr_ioctl(struct g_provider *pp, u_long cmd, void *data, int fflag, struct thread *td)
174 struct g_mbr_softc *ms;
175 struct g_slicer *gsp;
176 struct g_consumer *cp;
187 if (!(fflag & FWRITE))
191 cp = LIST_FIRST(&gp->consumer);
193 error = g_access(cp, 0, 1, 0);
198 error = g_mbr_modify(gp, ms, data, 512);
200 error = g_write_data(cp, 0, data, 512);
202 g_access(cp, 0, -1 , 0);
213 g_mbr_start(struct bio *bp)
215 struct g_provider *pp;
217 struct g_mbr_softc *mp;
218 struct g_slicer *gsp;
226 if (bp->bio_cmd == BIO_GETATTR) {
227 if (g_handleattr_int(bp, "MBR::type", mp->type[idx]))
229 if (g_handleattr_off_t(bp, "MBR::offset",
230 gsp->slices[idx].offset))
232 if (g_handleattr(bp, "MBR::slicesum", mp->slicesum,
233 sizeof(mp->slicesum)))
241 g_mbr_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp __unused, struct g_provider *pp)
243 struct g_mbr_softc *mp;
244 struct g_slicer *gsp;
248 g_slice_dumpconf(sb, indent, gp, cp, pp);
251 sbuf_printf(sb, " ty %d", mp->type[pp->index]);
253 sbuf_printf(sb, "%s<type>%d</type>\n", indent,
254 mp->type[pp->index]);
258 static struct g_geom *
259 g_mbr_taste(struct g_class *mp, struct g_provider *pp, int insist)
262 struct g_consumer *cp;
264 struct g_mbr_softc *ms;
265 u_int fwsectors, sectorsize;
270 g_trace(G_T_TOPOLOGY, "mbr_taste(%s,%s)", mp->name, pp->name);
272 if (!strcmp(pp->geom->class->name, MBR_CLASS_NAME))
274 gp = g_slice_new(mp, NDOSPART, pp, &cp, &ms, sizeof *ms, g_mbr_start);
279 error = g_getattr("GEOM::fwsectors", cp, &fwsectors);
282 sectorsize = cp->provider->sectorsize;
283 if (sectorsize < 512)
285 ms->sectorsize = sectorsize;
286 buf = g_read_data(cp, 0, sectorsize, NULL);
291 * Calculate MD5 from the first sector and use it for avoiding
292 * recursive slices creation.
294 bcopy(buf, ms->sec0, 512);
296 MD5Update(&md5sum, ms->sec0, sizeof(ms->sec0));
297 MD5Final(ms->slicesum, &md5sum);
299 error = g_getattr("MBR::slicesum", cp, &hash);
300 if (!error && !bcmp(ms->slicesum, hash, sizeof(hash))) {
306 g_mbr_modify(gp, ms, buf, 512);
312 g_access(cp, -1, 0, 0);
313 if (LIST_EMPTY(&gp->provider)) {
321 g_mbr_config(struct gctl_req *req, struct g_class *mp, const char *verb)
324 struct g_consumer *cp;
325 struct g_mbr_softc *ms;
326 struct g_slicer *gsp;
327 int opened = 0, error = 0;
332 gp = gctl_get_geom(req, mp, "geom");
335 if (strcmp(verb, "write MBR")) {
336 gctl_error(req, "Unknown verb");
341 data = gctl_get_param(req, "data", &len);
344 if (len < 512 || (len % 512)) {
345 gctl_error(req, "Wrong request length");
348 cp = LIST_FIRST(&gp->consumer);
350 error = g_access(cp, 0, 1, 0);
355 error = g_mbr_modify(gp, ms, data, len);
357 gctl_error(req, "conflict with open slices");
359 error = g_write_data(cp, 0, data, len);
361 gctl_error(req, "sector zero write failed");
363 g_access(cp, 0, -1 , 0);
367 static struct g_class g_mbr_class = {
368 .name = MBR_CLASS_NAME,
369 .version = G_VERSION,
370 .taste = g_mbr_taste,
371 .dumpconf = g_mbr_dumpconf,
372 .ctlreq = g_mbr_config,
373 .ioctl = g_mbr_ioctl,
376 DECLARE_GEOM_CLASS(g_mbr_class, g_mbr);
378 #define NDOSEXTPART 32
379 struct g_mbrext_softc {
380 int type [NDOSEXTPART];
384 g_mbrext_start(struct bio *bp)
386 struct g_provider *pp;
388 struct g_mbrext_softc *mp;
389 struct g_slicer *gsp;
397 if (bp->bio_cmd == BIO_GETATTR) {
398 if (g_handleattr_int(bp, "MBR::type", mp->type[idx]))
405 g_mbrext_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp, struct g_consumer *cp __unused, struct g_provider *pp)
407 struct g_mbrext_softc *mp;
408 struct g_slicer *gsp;
410 g_slice_dumpconf(sb, indent, gp, cp, pp);
415 sbuf_printf(sb, " ty %d", mp->type[pp->index]);
417 sbuf_printf(sb, "%s<type>%d</type>\n", indent,
418 mp->type[pp->index]);
422 static struct g_geom *
423 g_mbrext_taste(struct g_class *mp, struct g_provider *pp, int insist __unused)
426 struct g_consumer *cp;
428 struct g_mbrext_softc *ms;
431 struct dos_partition dp[4];
432 u_int fwsectors, sectorsize;
434 g_trace(G_T_TOPOLOGY, "g_mbrext_taste(%s,%s)", mp->name, pp->name);
436 if (strcmp(pp->geom->class->name, MBR_CLASS_NAME))
438 gp = g_slice_new(mp, NDOSEXTPART, pp, &cp, &ms, sizeof *ms,
446 error = g_getattr("MBR::type", cp, &i);
447 if (error || (i != DOSPTYP_EXT && i != DOSPTYP_EXTLBA))
449 error = g_getattr("GEOM::fwsectors", cp, &fwsectors);
452 sectorsize = cp->provider->sectorsize;
453 if (sectorsize != 512)
456 buf = g_read_data(cp, off, sectorsize, NULL);
459 if (buf[0x1fe] != 0x55 && buf[0x1ff] != 0xaa) {
463 for (i = 0; i < NDOSPART; i++)
466 i * sizeof(struct dos_partition), dp + i);
468 if (0 && bootverbose) {
469 printf("MBREXT Slice %d on %s:\n",
470 slice + 5, gp->name);
472 g_mbr_print(1, dp + 1);
474 if ((dp[0].dp_flag & 0x7f) == 0 &&
475 dp[0].dp_size != 0 && dp[0].dp_typ != 0) {
477 g_slice_config(gp, slice, G_SLICE_CONFIG_SET,
478 (((off_t)dp[0].dp_start) << 9ULL) + off,
479 ((off_t)dp[0].dp_size) << 9ULL,
482 strlen(gp->name) - 1,
483 strlen(gp->name) - 1,
487 ms->type[slice] = dp[0].dp_typ;
490 if (dp[1].dp_flag != 0)
492 if (dp[1].dp_typ != DOSPTYP_EXT &&
493 dp[1].dp_typ != DOSPTYP_EXTLBA)
495 if (dp[1].dp_size == 0)
497 off = ((off_t)dp[1].dp_start) << 9ULL;
502 g_access(cp, -1, 0, 0);
503 if (LIST_EMPTY(&gp->provider)) {
511 static struct g_class g_mbrext_class = {
512 .name = MBREXT_CLASS_NAME,
513 .version = G_VERSION,
514 .taste = g_mbrext_taste,
515 .dumpconf = g_mbrext_dumpconf,
518 DECLARE_GEOM_CLASS(g_mbrext_class, g_mbrext);