#include <sys/types.h>
#include <sys/disklabel.h>
#include <err.h>
#include <stddef.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include "map.h"
#include "gpt.h"
static uuid_t type;
static off_t block, size;
static void
usage_add(void)
{
fprintf(stderr,
"usage: %s [-b lba] [-s lba] [-t uuid] device\n", getprogname());
exit(1);
}
static void
add(int fd)
{
map_t *gpt, *tpg;
map_t *tbl, *lbt;
map_t *map;
struct gpt_hdr *hdr;
struct gpt_ent *ent;
unsigned int i;
gpt = map_find(MAP_TYPE_PRI_GPT_HDR);
if (gpt == NULL) {
warnx("%s: error: no primary GPT header; run create or recover",
device_name);
return;
}
tpg = map_find(MAP_TYPE_SEC_GPT_HDR);
if (tpg == NULL) {
warnx("%s: error: no secondary GPT header; run recover",
device_name);
return;
}
tbl = map_find(MAP_TYPE_PRI_GPT_TBL);
lbt = map_find(MAP_TYPE_SEC_GPT_TBL);
if (tbl == NULL || lbt == NULL) {
warnx("%s: error: run recover -- trust me", device_name);
return;
}
#ifdef __APPLE__
if (uuid_is_null(type))
uuid_copy(type, GPT_ENT_TYPE_APPLE_HFS);
#else
if (uuid_is_nil(&type, NULL)) {
uuid_t ufs = GPT_ENT_TYPE_FREEBSD_UFS;
type = ufs;
}
#endif
map = map_alloc(block, size);
if (map == NULL) {
warnx("%s: error: no space available on device", device_name);
return;
}
ent = NULL;
hdr = gpt->map_data;
for (i = 0; i < le32toh(hdr->hdr_entries); i++) {
ent = (void*)((char*)tbl->map_data + i * le32toh(hdr->hdr_entsz));
#ifdef __APPLE__
if (uuid_is_null(ent->ent_type))
#else
if (uuid_is_nil(&ent->ent_type, NULL))
#endif
break;
}
if (i == le32toh(hdr->hdr_entries)) {
warnx("%s: error: no available table entries", device_name);
return;
}
#ifdef __APPLE__
bswap_uuid(type, ent->ent_type);
#else
le_uuid_enc(&ent->ent_type, &type);
#endif
ent->ent_lba_start = htole64(map->map_start);
ent->ent_lba_end = htole64(map->map_start + map->map_size - 1LL);
hdr->hdr_crc_table = htole32(crc32(tbl->map_data,
le32toh(hdr->hdr_entries) * le32toh(hdr->hdr_entsz)));
hdr->hdr_crc_self = 0;
hdr->hdr_crc_self = htole32(crc32(hdr, le32toh(hdr->hdr_size)));
gpt_write(fd, gpt);
gpt_write(fd, tbl);
hdr = tpg->map_data;
ent = (void*)((char*)lbt->map_data + i * le32toh(hdr->hdr_entsz));
#ifdef __APPLE__
bswap_uuid(type, ent->ent_type);
#else
le_uuid_enc(&ent->ent_type, &type);
#endif
ent->ent_lba_start = htole64(map->map_start);
ent->ent_lba_end = htole64(map->map_start + map->map_size - 1LL);
hdr->hdr_crc_table = htole32(crc32(lbt->map_data,
le32toh(hdr->hdr_entries) * le32toh(hdr->hdr_entsz)));
hdr->hdr_crc_self = 0;
hdr->hdr_crc_self = htole32(crc32(hdr, le32toh(hdr->hdr_size)));
gpt_write(fd, lbt);
gpt_write(fd, tpg);
}
int
cmd_add(int argc, char *argv[])
{
char *p;
int ch, fd;
uint32_t status;
while ((ch = getopt(argc, argv, "b:s:t:")) != -1) {
switch(ch) {
case 'b':
if (block > 0)
usage_add();
block = strtol(optarg, &p, 10);
if (*p != 0 || block < 1)
usage_add();
break;
case 's':
if (size > 0)
usage_add();
size = strtol(optarg, &p, 10);
if (*p != 0 || size < 1)
usage_add();
break;
case 't':
#ifdef __APPLE__
if (!uuid_is_null(type))
usage_add();
status = uuid_parse(optarg, type);
if (status) {
if (strcmp(optarg, "efi") == 0)
uuid_copy(type, GPT_ENT_TYPE_INTEL_ESP);
else if (strcmp(optarg, "hfs") == 0)
uuid_copy(type, GPT_ENT_TYPE_APPLE_HFS);
else if (strcmp(optarg, "ufs") == 0)
uuid_copy(type, GPT_ENT_TYPE_APPLE_UFS);
else
usage_add();
}
#else
if (!uuid_is_nil(&type, NULL))
usage_add();
uuid_from_string(optarg, &type, &status);
if (status != uuid_s_ok) {
if (strcmp(optarg, "efi") == 0) {
uuid_t efi = GPT_ENT_TYPE_EFI;
type = efi;
} else if (strcmp(optarg, "swap") == 0) {
uuid_t sw = GPT_ENT_TYPE_FREEBSD_SWAP;
type = sw;
} else if (strcmp(optarg, "ufs") == 0) {
uuid_t ufs = GPT_ENT_TYPE_FREEBSD_UFS;
type = ufs;
} else
usage_add();
}
#endif
break;
default:
usage_add();
}
}
if (argc == optind)
usage_add();
while (optind < argc) {
fd = gpt_open(argv[optind++]);
if (fd == -1) {
warn("unable to open device '%s'", device_name);
continue;
}
add(fd);
gpt_close(fd);
}
return (0);
}