Home | History | Annotate | Line # | Download | only in gpt
add.c revision 1.1
      1  1.1  christos /*-
      2  1.1  christos  * Copyright (c) 2002 Marcel Moolenaar
      3  1.1  christos  * All rights reserved.
      4  1.1  christos  *
      5  1.1  christos  * Redistribution and use in source and binary forms, with or without
      6  1.1  christos  * modification, are permitted provided that the following conditions
      7  1.1  christos  * are met:
      8  1.1  christos  *
      9  1.1  christos  * 1. Redistributions of source code must retain the above copyright
     10  1.1  christos  *    notice, this list of conditions and the following disclaimer.
     11  1.1  christos  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  christos  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  christos  *    documentation and/or other materials provided with the distribution.
     14  1.1  christos  *
     15  1.1  christos  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  1.1  christos  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     17  1.1  christos  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     18  1.1  christos  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     19  1.1  christos  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     20  1.1  christos  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     21  1.1  christos  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     22  1.1  christos  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     23  1.1  christos  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     24  1.1  christos  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     25  1.1  christos  */
     26  1.1  christos 
     27  1.1  christos #include <sys/cdefs.h>
     28  1.1  christos __FBSDID("$FreeBSD: src/sbin/gpt/add.c,v 1.15 2006/10/04 18:20:25 marcel Exp $");
     29  1.1  christos 
     30  1.1  christos #include <sys/types.h>
     31  1.1  christos 
     32  1.1  christos #include <err.h>
     33  1.1  christos #include <stddef.h>
     34  1.1  christos #include <stdio.h>
     35  1.1  christos #include <stdlib.h>
     36  1.1  christos #include <string.h>
     37  1.1  christos #include <unistd.h>
     38  1.1  christos 
     39  1.1  christos #include "map.h"
     40  1.1  christos #include "gpt.h"
     41  1.1  christos 
     42  1.1  christos static uuid_t type;
     43  1.1  christos static off_t block, size;
     44  1.1  christos static unsigned int entry;
     45  1.1  christos 
     46  1.1  christos static void
     47  1.1  christos usage_add(void)
     48  1.1  christos {
     49  1.1  christos 
     50  1.1  christos 	fprintf(stderr,
     51  1.1  christos 	    "usage: %s [-b lba] [-i index] [-s lba] [-t uuid] device ...\n",
     52  1.1  christos 	    getprogname());
     53  1.1  christos 	exit(1);
     54  1.1  christos }
     55  1.1  christos 
     56  1.1  christos static void
     57  1.1  christos add(int fd)
     58  1.1  christos {
     59  1.1  christos 	map_t *gpt, *tpg;
     60  1.1  christos 	map_t *tbl, *lbt;
     61  1.1  christos 	map_t *map;
     62  1.1  christos 	struct gpt_hdr *hdr;
     63  1.1  christos 	struct gpt_ent *ent;
     64  1.1  christos 	unsigned int i;
     65  1.1  christos 
     66  1.1  christos 	gpt = map_find(MAP_TYPE_PRI_GPT_HDR);
     67  1.1  christos 	if (gpt == NULL) {
     68  1.1  christos 		warnx("%s: error: no primary GPT header; run create or recover",
     69  1.1  christos 		    device_name);
     70  1.1  christos 		return;
     71  1.1  christos 	}
     72  1.1  christos 
     73  1.1  christos 	tpg = map_find(MAP_TYPE_SEC_GPT_HDR);
     74  1.1  christos 	if (tpg == NULL) {
     75  1.1  christos 		warnx("%s: error: no secondary GPT header; run recover",
     76  1.1  christos 		    device_name);
     77  1.1  christos 		return;
     78  1.1  christos 	}
     79  1.1  christos 
     80  1.1  christos 	tbl = map_find(MAP_TYPE_PRI_GPT_TBL);
     81  1.1  christos 	lbt = map_find(MAP_TYPE_SEC_GPT_TBL);
     82  1.1  christos 	if (tbl == NULL || lbt == NULL) {
     83  1.1  christos 		warnx("%s: error: run recover -- trust me", device_name);
     84  1.1  christos 		return;
     85  1.1  christos 	}
     86  1.1  christos 
     87  1.1  christos 	hdr = gpt->map_data;
     88  1.1  christos 	if (entry > le32toh(hdr->hdr_entries)) {
     89  1.1  christos 		warnx("%s: error: index %u out of range (%u max)", device_name,
     90  1.1  christos 		    entry, le32toh(hdr->hdr_entries));
     91  1.1  christos 		return;
     92  1.1  christos 	}
     93  1.1  christos 
     94  1.1  christos 	if (entry > 0) {
     95  1.1  christos 		i = entry - 1;
     96  1.1  christos 		ent = (void*)((char*)tbl->map_data + i *
     97  1.1  christos 		    le32toh(hdr->hdr_entsz));
     98  1.1  christos 		if (!uuid_is_nil(&ent->ent_type, NULL)) {
     99  1.1  christos 			warnx("%s: error: entry at index %u is not free",
    100  1.1  christos 			    device_name, entry);
    101  1.1  christos 			return;
    102  1.1  christos 		}
    103  1.1  christos 	} else {
    104  1.1  christos 		/* Find empty slot in GPT table. */
    105  1.1  christos 		for (i = 0; i < le32toh(hdr->hdr_entries); i++) {
    106  1.1  christos 			ent = (void*)((char*)tbl->map_data + i *
    107  1.1  christos 			    le32toh(hdr->hdr_entsz));
    108  1.1  christos 			if (uuid_is_nil(&ent->ent_type, NULL))
    109  1.1  christos 				break;
    110  1.1  christos 		}
    111  1.1  christos 		if (i == le32toh(hdr->hdr_entries)) {
    112  1.1  christos 			warnx("%s: error: no available table entries",
    113  1.1  christos 			    device_name);
    114  1.1  christos 			return;
    115  1.1  christos 		}
    116  1.1  christos 	}
    117  1.1  christos 
    118  1.1  christos 	map = map_alloc(block, size);
    119  1.1  christos 	if (map == NULL) {
    120  1.1  christos 		warnx("%s: error: no space available on device", device_name);
    121  1.1  christos 		return;
    122  1.1  christos 	}
    123  1.1  christos 
    124  1.1  christos 	le_uuid_enc(&ent->ent_type, &type);
    125  1.1  christos 	ent->ent_lba_start = htole64(map->map_start);
    126  1.1  christos 	ent->ent_lba_end = htole64(map->map_start + map->map_size - 1LL);
    127  1.1  christos 
    128  1.1  christos 	hdr->hdr_crc_table = htole32(crc32(tbl->map_data,
    129  1.1  christos 	    le32toh(hdr->hdr_entries) * le32toh(hdr->hdr_entsz)));
    130  1.1  christos 	hdr->hdr_crc_self = 0;
    131  1.1  christos 	hdr->hdr_crc_self = htole32(crc32(hdr, le32toh(hdr->hdr_size)));
    132  1.1  christos 
    133  1.1  christos 	gpt_write(fd, gpt);
    134  1.1  christos 	gpt_write(fd, tbl);
    135  1.1  christos 
    136  1.1  christos 	hdr = tpg->map_data;
    137  1.1  christos 	ent = (void*)((char*)lbt->map_data + i * le32toh(hdr->hdr_entsz));
    138  1.1  christos 
    139  1.1  christos 	le_uuid_enc(&ent->ent_type, &type);
    140  1.1  christos 	ent->ent_lba_start = htole64(map->map_start);
    141  1.1  christos 	ent->ent_lba_end = htole64(map->map_start + map->map_size - 1LL);
    142  1.1  christos 
    143  1.1  christos 	hdr->hdr_crc_table = htole32(crc32(lbt->map_data,
    144  1.1  christos 	    le32toh(hdr->hdr_entries) * le32toh(hdr->hdr_entsz)));
    145  1.1  christos 	hdr->hdr_crc_self = 0;
    146  1.1  christos 	hdr->hdr_crc_self = htole32(crc32(hdr, le32toh(hdr->hdr_size)));
    147  1.1  christos 
    148  1.1  christos 	gpt_write(fd, lbt);
    149  1.1  christos 	gpt_write(fd, tpg);
    150  1.1  christos 
    151  1.1  christos 	printf("%sp%u added\n", device_name, i + 1);
    152  1.1  christos }
    153  1.1  christos 
    154  1.1  christos int
    155  1.1  christos cmd_add(int argc, char *argv[])
    156  1.1  christos {
    157  1.1  christos 	char *p;
    158  1.1  christos 	int ch, fd;
    159  1.1  christos 
    160  1.1  christos 	/* Get the migrate options */
    161  1.1  christos 	while ((ch = getopt(argc, argv, "b:i:s:t:")) != -1) {
    162  1.1  christos 		switch(ch) {
    163  1.1  christos 		case 'b':
    164  1.1  christos 			if (block > 0)
    165  1.1  christos 				usage_add();
    166  1.1  christos 			block = strtoll(optarg, &p, 10);
    167  1.1  christos 			if (*p != 0 || block < 1)
    168  1.1  christos 				usage_add();
    169  1.1  christos 			break;
    170  1.1  christos 		case 'i':
    171  1.1  christos 			if (entry > 0)
    172  1.1  christos 				usage_add();
    173  1.1  christos 			entry = strtol(optarg, &p, 10);
    174  1.1  christos 			if (*p != 0 || entry < 1)
    175  1.1  christos 				usage_add();
    176  1.1  christos 			break;
    177  1.1  christos 		case 's':
    178  1.1  christos 			if (size > 0)
    179  1.1  christos 				usage_add();
    180  1.1  christos 			size = strtoll(optarg, &p, 10);
    181  1.1  christos 			if (*p != 0 || size < 1)
    182  1.1  christos 				usage_add();
    183  1.1  christos 			break;
    184  1.1  christos 		case 't':
    185  1.1  christos 			if (!uuid_is_nil(&type, NULL))
    186  1.1  christos 				usage_add();
    187  1.1  christos 			if (parse_uuid(optarg, &type) != 0)
    188  1.1  christos 				usage_add();
    189  1.1  christos 			break;
    190  1.1  christos 		default:
    191  1.1  christos 			usage_add();
    192  1.1  christos 		}
    193  1.1  christos 	}
    194  1.1  christos 
    195  1.1  christos 	if (argc == optind)
    196  1.1  christos 		usage_add();
    197  1.1  christos 
    198  1.1  christos 	/* Create UFS partitions by default. */
    199  1.1  christos 	if (uuid_is_nil(&type, NULL)) {
    200  1.1  christos 		uuid_t ufs = GPT_ENT_TYPE_FREEBSD_UFS;
    201  1.1  christos 		type = ufs;
    202  1.1  christos 	}
    203  1.1  christos 
    204  1.1  christos 	while (optind < argc) {
    205  1.1  christos 		fd = gpt_open(argv[optind++]);
    206  1.1  christos 		if (fd == -1) {
    207  1.1  christos 			warn("unable to open device '%s'", device_name);
    208  1.1  christos 			continue;
    209  1.1  christos 		}
    210  1.1  christos 
    211  1.1  christos 		add(fd);
    212  1.1  christos 
    213  1.1  christos 		gpt_close(fd);
    214  1.1  christos 	}
    215  1.1  christos 
    216  1.1  christos 	return (0);
    217  1.1  christos }
    218