2 * Copyright (c) 2008 Marcel Moolenaar
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/param.h>
32 #include <sys/endian.h>
33 #include <sys/kernel.h>
35 #include <sys/limits.h>
37 #include <sys/malloc.h>
38 #include <sys/mutex.h>
39 #include <sys/queue.h>
41 #include <sys/systm.h>
43 #include <geom/geom.h>
44 #include <geom/part/g_part.h>
46 #include "g_part_if.h"
48 struct g_part_vtoc8_table {
49 struct g_part_table base;
54 static int g_part_vtoc8_add(struct g_part_table *, struct g_part_entry *,
55 struct g_part_parms *);
56 static int g_part_vtoc8_create(struct g_part_table *, struct g_part_parms *);
57 static int g_part_vtoc8_destroy(struct g_part_table *, struct g_part_parms *);
58 static int g_part_vtoc8_dumpto(struct g_part_table *, struct g_part_entry *);
59 static int g_part_vtoc8_modify(struct g_part_table *, struct g_part_entry *,
60 struct g_part_parms *);
61 static char *g_part_vtoc8_name(struct g_part_table *, struct g_part_entry *,
63 static int g_part_vtoc8_probe(struct g_part_table *, struct g_consumer *);
64 static int g_part_vtoc8_read(struct g_part_table *, struct g_consumer *);
65 static const char *g_part_vtoc8_type(struct g_part_table *, struct g_part_entry *,
67 static int g_part_vtoc8_write(struct g_part_table *, struct g_consumer *);
69 static kobj_method_t g_part_vtoc8_methods[] = {
70 KOBJMETHOD(g_part_add, g_part_vtoc8_add),
71 KOBJMETHOD(g_part_create, g_part_vtoc8_create),
72 KOBJMETHOD(g_part_destroy, g_part_vtoc8_destroy),
73 KOBJMETHOD(g_part_dumpto, g_part_vtoc8_dumpto),
74 KOBJMETHOD(g_part_modify, g_part_vtoc8_modify),
75 KOBJMETHOD(g_part_name, g_part_vtoc8_name),
76 KOBJMETHOD(g_part_probe, g_part_vtoc8_probe),
77 KOBJMETHOD(g_part_read, g_part_vtoc8_read),
78 KOBJMETHOD(g_part_type, g_part_vtoc8_type),
79 KOBJMETHOD(g_part_write, g_part_vtoc8_write),
83 static struct g_part_scheme g_part_vtoc8_scheme = {
86 sizeof(struct g_part_vtoc8_table),
87 .gps_entrysz = sizeof(struct g_part_entry),
88 .gps_minent = VTOC8_NPARTS,
89 .gps_maxent = VTOC8_NPARTS,
91 G_PART_SCHEME_DECLARE(g_part_vtoc8);
94 vtoc8_parse_type(const char *type, uint16_t *tag)
100 if (type[0] == '!') {
101 lt = strtol(type + 1, &endp, 0);
102 if (type[1] == '\0' || *endp != '\0' || lt <= 0 ||
108 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_SWAP);
109 if (!strcasecmp(type, alias)) {
110 *tag = VTOC_TAG_FREEBSD_SWAP;
113 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_UFS);
114 if (!strcasecmp(type, alias)) {
115 *tag = VTOC_TAG_FREEBSD_UFS;
118 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_VINUM);
119 if (!strcasecmp(type, alias)) {
120 *tag = VTOC_TAG_FREEBSD_VINUM;
123 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_ZFS);
124 if (!strcasecmp(type, alias)) {
125 *tag = VTOC_TAG_FREEBSD_ZFS;
132 g_part_vtoc8_add(struct g_part_table *basetable, struct g_part_entry *entry,
133 struct g_part_parms *gpp)
135 struct g_part_vtoc8_table *table;
137 uint64_t start, size;
140 if (gpp->gpp_parms & G_PART_PARM_LABEL)
143 error = vtoc8_parse_type(gpp->gpp_type, &tag);
147 table = (struct g_part_vtoc8_table *)basetable;
148 index = entry->gpe_index - 1;
150 start = gpp->gpp_start;
151 size = gpp->gpp_size;
152 if (start % table->secpercyl) {
153 size = size - table->secpercyl + (start % table->secpercyl);
154 start = start - (start % table->secpercyl) + table->secpercyl;
156 if (size % table->secpercyl)
157 size = size - (size % table->secpercyl);
158 if (size < table->secpercyl)
161 KASSERT(entry->gpe_start <= start, (__func__));
162 KASSERT(entry->gpe_end >= start + size - 1, (__func__));
163 entry->gpe_start = start;
164 entry->gpe_end = start + size - 1;
166 be16enc(&table->vtoc.part[index].tag, tag);
167 be16enc(&table->vtoc.part[index].flag, 0);
168 be32enc(&table->vtoc.timestamp[index], 0);
169 be32enc(&table->vtoc.map[index].cyl, start / table->secpercyl);
170 be32enc(&table->vtoc.map[index].nblks, size);
175 g_part_vtoc8_create(struct g_part_table *basetable, struct g_part_parms *gpp)
177 struct g_consumer *cp;
178 struct g_provider *pp;
179 struct g_part_entry *entry;
180 struct g_part_vtoc8_table *table;
182 uint32_t acyls, ncyls, pcyls;
184 pp = gpp->gpp_provider;
185 cp = LIST_FIRST(&pp->consumers);
187 if (pp->sectorsize < sizeof(struct vtoc8))
189 if (pp->sectorsize > sizeof(struct vtoc8))
192 table = (struct g_part_vtoc8_table *)basetable;
194 msize = pp->mediasize / pp->sectorsize;
195 if (msize > 0xffffffffu)
197 table->secpercyl = basetable->gpt_sectors * basetable->gpt_heads;
198 pcyls = msize / table->secpercyl;
200 ncyls = pcyls - acyls;
201 msize = ncyls * table->secpercyl;
203 sprintf(table->vtoc.ascii, "FreeBSD%lldM cyl %u alt %u hd %u sec %u",
204 (long long)(msize / 2048), ncyls, acyls, basetable->gpt_heads,
205 basetable->gpt_sectors);
206 be32enc(&table->vtoc.version, VTOC_VERSION);
207 be16enc(&table->vtoc.nparts, VTOC8_NPARTS);
208 be32enc(&table->vtoc.sanity, VTOC_SANITY);
209 be16enc(&table->vtoc.rpm, 3600);
210 be16enc(&table->vtoc.physcyls, pcyls);
211 be16enc(&table->vtoc.ncyls, ncyls);
212 be16enc(&table->vtoc.altcyls, acyls);
213 be16enc(&table->vtoc.nheads, basetable->gpt_heads);
214 be16enc(&table->vtoc.nsecs, basetable->gpt_sectors);
215 be16enc(&table->vtoc.magic, VTOC_MAGIC);
217 basetable->gpt_first = 0;
218 basetable->gpt_last = msize - 1;
219 basetable->gpt_isleaf = 1;
221 entry = g_part_new_entry(basetable, VTOC_RAW_PART + 1,
222 basetable->gpt_first, basetable->gpt_last);
223 entry->gpe_internal = 1;
224 be16enc(&table->vtoc.part[VTOC_RAW_PART].tag, VTOC_TAG_BACKUP);
225 be32enc(&table->vtoc.map[VTOC_RAW_PART].nblks, msize);
230 g_part_vtoc8_destroy(struct g_part_table *basetable, struct g_part_parms *gpp)
233 /* Wipe the first sector to clear the partitioning. */
234 basetable->gpt_smhead |= 1;
239 g_part_vtoc8_dumpto(struct g_part_table *basetable, struct g_part_entry *entry)
241 struct g_part_vtoc8_table *table;
244 /* Allow dumping to a swap partition only. */
245 table = (struct g_part_vtoc8_table *)basetable;
246 tag = be16dec(&table->vtoc.part[entry->gpe_index - 1].tag);
247 return ((tag == VTOC_TAG_FREEBSD_SWAP) ? 1 : 0);
251 g_part_vtoc8_modify(struct g_part_table *basetable,
252 struct g_part_entry *entry, struct g_part_parms *gpp)
254 struct g_part_vtoc8_table *table;
258 if (gpp->gpp_parms & G_PART_PARM_LABEL)
261 table = (struct g_part_vtoc8_table *)basetable;
262 if (gpp->gpp_parms & G_PART_PARM_TYPE) {
263 error = vtoc8_parse_type(gpp->gpp_type, &tag);
267 be16enc(&table->vtoc.part[entry->gpe_index - 1].tag, tag);
273 g_part_vtoc8_name(struct g_part_table *table, struct g_part_entry *baseentry,
274 char *buf, size_t bufsz)
277 snprintf(buf, bufsz, "%c", 'a' + baseentry->gpe_index - 1);
282 g_part_vtoc8_probe(struct g_part_table *table, struct g_consumer *cp)
284 struct g_provider *pp;
287 uint16_t cksum, magic;
291 /* Sanity-check the provider. */
292 if (pp->sectorsize != sizeof(struct vtoc8))
295 /* Check that there's a disklabel. */
296 buf = g_read_data(cp, 0, pp->sectorsize, &error);
300 res = ENXIO; /* Assume mismatch */
302 /* Check the magic */
303 magic = be16dec(buf + offsetof(struct vtoc8, magic));
304 if (magic != VTOC_MAGIC)
309 for (ofs = 0; ofs < sizeof(struct vtoc8); ofs += 2)
310 cksum ^= be16dec(buf + ofs);
314 res = G_PART_PROBE_PRI_NORM;
322 g_part_vtoc8_read(struct g_part_table *basetable, struct g_consumer *cp)
324 struct g_provider *pp;
325 struct g_part_vtoc8_table *table;
326 struct g_part_entry *entry;
329 uint64_t offset, size;
330 u_int cyls, heads, sectors;
331 int error, index, withtags;
335 buf = g_read_data(cp, 0, pp->sectorsize, &error);
339 table = (struct g_part_vtoc8_table *)basetable;
340 bcopy(buf, &table->vtoc, sizeof(table->vtoc));
343 msize = pp->mediasize / pp->sectorsize;
345 sectors = be16dec(&table->vtoc.nsecs);
346 if (sectors < 1 || sectors > 63)
348 if (sectors != basetable->gpt_sectors && !basetable->gpt_fixgeom) {
349 g_part_geometry_heads(msize, sectors, &chs, &heads);
351 basetable->gpt_sectors = sectors;
352 basetable->gpt_heads = heads;
356 heads = be16dec(&table->vtoc.nheads);
357 if (heads < 1 || heads > 255)
359 if (heads != basetable->gpt_heads && !basetable->gpt_fixgeom)
360 basetable->gpt_heads = heads;
361 if (sectors != basetable->gpt_sectors ||
362 heads != basetable->gpt_heads)
363 printf("GEOM: %s: geometry does not match label.\n", pp->name);
365 table->secpercyl = heads * sectors;
366 cyls = be16dec(&table->vtoc.ncyls);
367 chs = cyls * table->secpercyl;
368 if (chs < 1 || chs > msize)
371 basetable->gpt_first = 0;
372 basetable->gpt_last = chs - 1;
373 basetable->gpt_isleaf = 1;
375 withtags = (be32dec(&table->vtoc.sanity) == VTOC_SANITY) ? 1 : 0;
377 printf("GEOM: %s: adding VTOC information.\n", pp->name);
378 be32enc(&table->vtoc.version, VTOC_VERSION);
379 bzero(&table->vtoc.volume, VTOC_VOLUME_LEN);
380 be16enc(&table->vtoc.nparts, VTOC8_NPARTS);
381 bzero(&table->vtoc.part, sizeof(table->vtoc.part));
382 be32enc(&table->vtoc.sanity, VTOC_SANITY);
385 basetable->gpt_entries = be16dec(&table->vtoc.nparts);
386 if (basetable->gpt_entries < g_part_vtoc8_scheme.gps_minent ||
387 basetable->gpt_entries > g_part_vtoc8_scheme.gps_maxent)
390 for (index = basetable->gpt_entries - 1; index >= 0; index--) {
391 offset = be32dec(&table->vtoc.map[index].cyl) *
393 size = be32dec(&table->vtoc.map[index].nblks);
397 tag = be16dec(&table->vtoc.part[index].tag);
399 tag = (index == VTOC_RAW_PART)
401 : VTOC_TAG_UNASSIGNED;
403 if (index == VTOC_RAW_PART && tag != VTOC_TAG_BACKUP)
405 if (index != VTOC_RAW_PART && tag == VTOC_TAG_BACKUP)
407 entry = g_part_new_entry(basetable, index + 1, offset,
409 if (tag == VTOC_TAG_BACKUP)
410 entry->gpe_internal = 1;
413 be16enc(&table->vtoc.part[index].tag, tag);
419 printf("GEOM: %s: invalid disklabel.\n", pp->name);
424 g_part_vtoc8_type(struct g_part_table *basetable, struct g_part_entry *entry,
425 char *buf, size_t bufsz)
427 struct g_part_vtoc8_table *table;
430 table = (struct g_part_vtoc8_table *)basetable;
431 tag = be16dec(&table->vtoc.part[entry->gpe_index - 1].tag);
432 if (tag == VTOC_TAG_FREEBSD_SWAP)
433 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_SWAP));
434 if (tag == VTOC_TAG_FREEBSD_UFS)
435 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_UFS));
436 if (tag == VTOC_TAG_FREEBSD_VINUM)
437 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_VINUM));
438 if (tag == VTOC_TAG_FREEBSD_ZFS)
439 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_ZFS));
440 snprintf(buf, bufsz, "!%d", tag);
445 g_part_vtoc8_write(struct g_part_table *basetable, struct g_consumer *cp)
447 struct g_provider *pp;
448 struct g_part_entry *entry;
449 struct g_part_vtoc8_table *table;
452 int error, index, match, offset;
455 table = (struct g_part_vtoc8_table *)basetable;
456 entry = LIST_FIRST(&basetable->gpt_entry);
457 for (index = 0; index < basetable->gpt_entries; index++) {
458 match = (entry != NULL && index == entry->gpe_index - 1)
461 if (entry->gpe_deleted) {
462 be16enc(&table->vtoc.part[index].tag, 0);
463 be16enc(&table->vtoc.part[index].flag, 0);
464 be32enc(&table->vtoc.map[index].cyl, 0);
465 be32enc(&table->vtoc.map[index].nblks, 0);
467 entry = LIST_NEXT(entry, gpe_entry);
471 /* Calculate checksum. */
473 p = (void *)&table->vtoc;
474 for (offset = 0; offset < sizeof(table->vtoc) - 2; offset += 2)
475 sum ^= be16dec(p + offset);
476 be16enc(&table->vtoc.cksum, sum);
478 error = g_write_data(cp, 0, p, pp->sectorsize);