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_dumpconf(struct g_part_table *, struct g_part_entry *,
59 struct sbuf *, const char *);
60 static int g_part_vtoc8_dumpto(struct g_part_table *, struct g_part_entry *);
61 static int g_part_vtoc8_modify(struct g_part_table *, struct g_part_entry *,
62 struct g_part_parms *);
63 static char *g_part_vtoc8_name(struct g_part_table *, struct g_part_entry *,
65 static int g_part_vtoc8_probe(struct g_part_table *, struct g_consumer *);
66 static int g_part_vtoc8_read(struct g_part_table *, struct g_consumer *);
67 static const char *g_part_vtoc8_type(struct g_part_table *, struct g_part_entry *,
69 static int g_part_vtoc8_write(struct g_part_table *, struct g_consumer *);
71 static kobj_method_t g_part_vtoc8_methods[] = {
72 KOBJMETHOD(g_part_add, g_part_vtoc8_add),
73 KOBJMETHOD(g_part_create, g_part_vtoc8_create),
74 KOBJMETHOD(g_part_destroy, g_part_vtoc8_destroy),
75 KOBJMETHOD(g_part_dumpconf, g_part_vtoc8_dumpconf),
76 KOBJMETHOD(g_part_dumpto, g_part_vtoc8_dumpto),
77 KOBJMETHOD(g_part_modify, g_part_vtoc8_modify),
78 KOBJMETHOD(g_part_name, g_part_vtoc8_name),
79 KOBJMETHOD(g_part_probe, g_part_vtoc8_probe),
80 KOBJMETHOD(g_part_read, g_part_vtoc8_read),
81 KOBJMETHOD(g_part_type, g_part_vtoc8_type),
82 KOBJMETHOD(g_part_write, g_part_vtoc8_write),
86 static struct g_part_scheme g_part_vtoc8_scheme = {
89 sizeof(struct g_part_vtoc8_table),
90 .gps_entrysz = sizeof(struct g_part_entry),
91 .gps_minent = VTOC8_NPARTS,
92 .gps_maxent = VTOC8_NPARTS,
94 G_PART_SCHEME_DECLARE(g_part_vtoc8);
97 vtoc8_parse_type(const char *type, uint16_t *tag)
103 if (type[0] == '!') {
104 lt = strtol(type + 1, &endp, 0);
105 if (type[1] == '\0' || *endp != '\0' || lt <= 0 ||
111 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_SWAP);
112 if (!strcasecmp(type, alias)) {
113 *tag = VTOC_TAG_FREEBSD_SWAP;
116 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_UFS);
117 if (!strcasecmp(type, alias)) {
118 *tag = VTOC_TAG_FREEBSD_UFS;
121 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_VINUM);
122 if (!strcasecmp(type, alias)) {
123 *tag = VTOC_TAG_FREEBSD_VINUM;
126 alias = g_part_alias_name(G_PART_ALIAS_FREEBSD_ZFS);
127 if (!strcasecmp(type, alias)) {
128 *tag = VTOC_TAG_FREEBSD_ZFS;
135 g_part_vtoc8_add(struct g_part_table *basetable, struct g_part_entry *entry,
136 struct g_part_parms *gpp)
138 struct g_part_vtoc8_table *table;
140 uint64_t start, size;
143 if (gpp->gpp_parms & G_PART_PARM_LABEL)
146 error = vtoc8_parse_type(gpp->gpp_type, &tag);
150 table = (struct g_part_vtoc8_table *)basetable;
151 index = entry->gpe_index - 1;
153 start = gpp->gpp_start;
154 size = gpp->gpp_size;
155 if (start % table->secpercyl) {
156 size = size - table->secpercyl + (start % table->secpercyl);
157 start = start - (start % table->secpercyl) + table->secpercyl;
159 if (size % table->secpercyl)
160 size = size - (size % table->secpercyl);
161 if (size < table->secpercyl)
164 KASSERT(entry->gpe_start <= start, (__func__));
165 KASSERT(entry->gpe_end >= start + size - 1, (__func__));
166 entry->gpe_start = start;
167 entry->gpe_end = start + size - 1;
169 be16enc(&table->vtoc.part[index].tag, tag);
170 be16enc(&table->vtoc.part[index].flag, 0);
171 be32enc(&table->vtoc.timestamp[index], 0);
172 be32enc(&table->vtoc.map[index].cyl, start / table->secpercyl);
173 be32enc(&table->vtoc.map[index].nblks, size);
178 g_part_vtoc8_create(struct g_part_table *basetable, struct g_part_parms *gpp)
180 struct g_consumer *cp;
181 struct g_provider *pp;
182 struct g_part_entry *entry;
183 struct g_part_vtoc8_table *table;
185 uint32_t acyls, ncyls, pcyls;
187 pp = gpp->gpp_provider;
188 cp = LIST_FIRST(&pp->consumers);
190 if (pp->sectorsize < sizeof(struct vtoc8))
192 if (pp->sectorsize > sizeof(struct vtoc8))
195 table = (struct g_part_vtoc8_table *)basetable;
197 msize = pp->mediasize / pp->sectorsize;
198 if (msize > 0xffffffffu)
200 table->secpercyl = basetable->gpt_sectors * basetable->gpt_heads;
201 pcyls = msize / table->secpercyl;
203 ncyls = pcyls - acyls;
204 msize = ncyls * table->secpercyl;
206 sprintf(table->vtoc.ascii, "FreeBSD%lldM cyl %u alt %u hd %u sec %u",
207 (long long)(msize / 2048), ncyls, acyls, basetable->gpt_heads,
208 basetable->gpt_sectors);
209 be32enc(&table->vtoc.version, VTOC_VERSION);
210 be16enc(&table->vtoc.nparts, VTOC8_NPARTS);
211 be32enc(&table->vtoc.sanity, VTOC_SANITY);
212 be16enc(&table->vtoc.rpm, 3600);
213 be16enc(&table->vtoc.physcyls, pcyls);
214 be16enc(&table->vtoc.ncyls, ncyls);
215 be16enc(&table->vtoc.altcyls, acyls);
216 be16enc(&table->vtoc.nheads, basetable->gpt_heads);
217 be16enc(&table->vtoc.nsecs, basetable->gpt_sectors);
218 be16enc(&table->vtoc.magic, VTOC_MAGIC);
220 basetable->gpt_first = 0;
221 basetable->gpt_last = msize - 1;
222 basetable->gpt_isleaf = 1;
224 entry = g_part_new_entry(basetable, VTOC_RAW_PART + 1,
225 basetable->gpt_first, basetable->gpt_last);
226 entry->gpe_internal = 1;
227 be16enc(&table->vtoc.part[VTOC_RAW_PART].tag, VTOC_TAG_BACKUP);
228 be32enc(&table->vtoc.map[VTOC_RAW_PART].nblks, msize);
233 g_part_vtoc8_destroy(struct g_part_table *basetable, struct g_part_parms *gpp)
236 /* Wipe the first sector to clear the partitioning. */
237 basetable->gpt_smhead |= 1;
242 g_part_vtoc8_dumpconf(struct g_part_table *basetable,
243 struct g_part_entry *entry, struct sbuf *sb, const char *indent)
245 struct g_part_vtoc8_table *table;
250 table = (struct g_part_vtoc8_table *)basetable;
251 sbuf_printf(sb, " xs SUN sc %u hd %u alt %u",
252 be16dec(&table->vtoc.nsecs), be16dec(&table->vtoc.nheads),
253 be16dec(&table->vtoc.altcyls));
258 g_part_vtoc8_dumpto(struct g_part_table *basetable, struct g_part_entry *entry)
260 struct g_part_vtoc8_table *table;
263 /* Allow dumping to a swap partition only. */
264 table = (struct g_part_vtoc8_table *)basetable;
265 tag = be16dec(&table->vtoc.part[entry->gpe_index - 1].tag);
266 return ((tag == VTOC_TAG_FREEBSD_SWAP) ? 1 : 0);
270 g_part_vtoc8_modify(struct g_part_table *basetable,
271 struct g_part_entry *entry, struct g_part_parms *gpp)
273 struct g_part_vtoc8_table *table;
277 if (gpp->gpp_parms & G_PART_PARM_LABEL)
280 table = (struct g_part_vtoc8_table *)basetable;
281 if (gpp->gpp_parms & G_PART_PARM_TYPE) {
282 error = vtoc8_parse_type(gpp->gpp_type, &tag);
286 be16enc(&table->vtoc.part[entry->gpe_index - 1].tag, tag);
292 g_part_vtoc8_name(struct g_part_table *table, struct g_part_entry *baseentry,
293 char *buf, size_t bufsz)
296 snprintf(buf, bufsz, "%c", 'a' + baseentry->gpe_index - 1);
301 g_part_vtoc8_probe(struct g_part_table *table, struct g_consumer *cp)
303 struct g_provider *pp;
306 uint16_t cksum, magic;
310 /* Sanity-check the provider. */
311 if (pp->sectorsize != sizeof(struct vtoc8))
314 /* Check that there's a disklabel. */
315 buf = g_read_data(cp, 0, pp->sectorsize, &error);
319 res = ENXIO; /* Assume mismatch */
321 /* Check the magic */
322 magic = be16dec(buf + offsetof(struct vtoc8, magic));
323 if (magic != VTOC_MAGIC)
328 for (ofs = 0; ofs < sizeof(struct vtoc8); ofs += 2)
329 cksum ^= be16dec(buf + ofs);
333 res = G_PART_PROBE_PRI_NORM;
341 g_part_vtoc8_read(struct g_part_table *basetable, struct g_consumer *cp)
343 struct g_provider *pp;
344 struct g_part_vtoc8_table *table;
345 struct g_part_entry *entry;
348 uint64_t offset, size;
349 u_int cyls, heads, sectors;
350 int error, index, withtags;
354 buf = g_read_data(cp, 0, pp->sectorsize, &error);
358 table = (struct g_part_vtoc8_table *)basetable;
359 bcopy(buf, &table->vtoc, sizeof(table->vtoc));
362 msize = pp->mediasize / pp->sectorsize;
364 sectors = be16dec(&table->vtoc.nsecs);
365 if (sectors < 1 || sectors > 63)
367 if (sectors != basetable->gpt_sectors && !basetable->gpt_fixgeom) {
368 g_part_geometry_heads(msize, sectors, &chs, &heads);
370 basetable->gpt_sectors = sectors;
371 basetable->gpt_heads = heads;
375 heads = be16dec(&table->vtoc.nheads);
376 if (heads < 1 || heads > 255)
378 if (heads != basetable->gpt_heads && !basetable->gpt_fixgeom)
379 basetable->gpt_heads = heads;
380 if (sectors != basetable->gpt_sectors ||
381 heads != basetable->gpt_heads)
382 printf("GEOM: %s: geometry does not match label.\n", pp->name);
384 table->secpercyl = heads * sectors;
385 cyls = be16dec(&table->vtoc.ncyls);
386 chs = cyls * table->secpercyl;
387 if (chs < 1 || chs > msize)
390 basetable->gpt_first = 0;
391 basetable->gpt_last = chs - 1;
392 basetable->gpt_isleaf = 1;
394 withtags = (be32dec(&table->vtoc.sanity) == VTOC_SANITY) ? 1 : 0;
396 printf("GEOM: %s: adding VTOC information.\n", pp->name);
397 be32enc(&table->vtoc.version, VTOC_VERSION);
398 bzero(&table->vtoc.volume, VTOC_VOLUME_LEN);
399 be16enc(&table->vtoc.nparts, VTOC8_NPARTS);
400 bzero(&table->vtoc.part, sizeof(table->vtoc.part));
401 be32enc(&table->vtoc.sanity, VTOC_SANITY);
404 basetable->gpt_entries = be16dec(&table->vtoc.nparts);
405 if (basetable->gpt_entries < g_part_vtoc8_scheme.gps_minent ||
406 basetable->gpt_entries > g_part_vtoc8_scheme.gps_maxent)
409 for (index = basetable->gpt_entries - 1; index >= 0; index--) {
410 offset = be32dec(&table->vtoc.map[index].cyl) *
412 size = be32dec(&table->vtoc.map[index].nblks);
416 tag = be16dec(&table->vtoc.part[index].tag);
418 tag = (index == VTOC_RAW_PART)
420 : VTOC_TAG_UNASSIGNED;
422 if (index == VTOC_RAW_PART && tag != VTOC_TAG_BACKUP)
424 if (index != VTOC_RAW_PART && tag == VTOC_TAG_BACKUP)
426 entry = g_part_new_entry(basetable, index + 1, offset,
428 if (tag == VTOC_TAG_BACKUP)
429 entry->gpe_internal = 1;
432 be16enc(&table->vtoc.part[index].tag, tag);
438 printf("GEOM: %s: invalid disklabel.\n", pp->name);
443 g_part_vtoc8_type(struct g_part_table *basetable, struct g_part_entry *entry,
444 char *buf, size_t bufsz)
446 struct g_part_vtoc8_table *table;
449 table = (struct g_part_vtoc8_table *)basetable;
450 tag = be16dec(&table->vtoc.part[entry->gpe_index - 1].tag);
451 if (tag == VTOC_TAG_FREEBSD_SWAP)
452 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_SWAP));
453 if (tag == VTOC_TAG_FREEBSD_UFS)
454 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_UFS));
455 if (tag == VTOC_TAG_FREEBSD_VINUM)
456 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_VINUM));
457 if (tag == VTOC_TAG_FREEBSD_ZFS)
458 return (g_part_alias_name(G_PART_ALIAS_FREEBSD_ZFS));
459 snprintf(buf, bufsz, "!%d", tag);
464 g_part_vtoc8_write(struct g_part_table *basetable, struct g_consumer *cp)
466 struct g_provider *pp;
467 struct g_part_entry *entry;
468 struct g_part_vtoc8_table *table;
471 int error, index, match, offset;
474 table = (struct g_part_vtoc8_table *)basetable;
475 entry = LIST_FIRST(&basetable->gpt_entry);
476 for (index = 0; index < basetable->gpt_entries; index++) {
477 match = (entry != NULL && index == entry->gpe_index - 1)
480 if (entry->gpe_deleted) {
481 be16enc(&table->vtoc.part[index].tag, 0);
482 be16enc(&table->vtoc.part[index].flag, 0);
483 be32enc(&table->vtoc.map[index].cyl, 0);
484 be32enc(&table->vtoc.map[index].nblks, 0);
486 entry = LIST_NEXT(entry, gpe_entry);
490 /* Calculate checksum. */
492 p = (void *)&table->vtoc;
493 for (offset = 0; offset < sizeof(table->vtoc) - 2; offset += 2)
494 sum ^= be16dec(p + offset);
495 be16enc(&table->vtoc.cksum, sum);
497 error = g_write_data(cp, 0, p, pp->sectorsize);