GRUB_MOD_LICENSE ("GPLv3+");
-static grub_uint8_t g_check_mbr_data[440] = {
+static grub_uint8_t g_check_mbr_data[] = {
0xEB, 0x63, 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x01, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFA, 0x90, 0x90, 0xF6, 0xC2, 0x80, 0x74, 0x05, 0xF6, 0xC2, 0x70,
- 0x74, 0x02, 0xB2, 0x80, 0xEA, 0x79, 0x7C, 0x00, 0x00, 0x31, 0xC0, 0x8E, 0xD8, 0x8E, 0xD0, 0xBC,
- 0x00, 0x20, 0xFB, 0xA0, 0x64, 0x7C, 0x3C, 0xFF, 0x74, 0x02, 0x88, 0xC2, 0x52, 0xBE, 0x90, 0x7D,
- 0xE8, 0x16, 0x01, 0xBE, 0x05, 0x7C, 0xB4, 0x41, 0xBB, 0xAA, 0x55, 0xCD, 0x13, 0x5A, 0x52, 0x72,
- 0x3D, 0x81, 0xFB, 0x55, 0xAA, 0x75, 0x37, 0x83, 0xE1, 0x01, 0x74, 0x32, 0x31, 0xC0, 0x89, 0x44,
- 0x04, 0x40, 0x88, 0x44, 0xFF, 0x89, 0x44, 0x02, 0xC7, 0x04, 0x10, 0x00, 0x66, 0x8B, 0x1E, 0x5C,
- 0x7C, 0x66, 0x89, 0x5C, 0x08, 0x66, 0x8B, 0x1E, 0x60, 0x7C, 0x66, 0x89, 0x5C, 0x0C, 0xC7, 0x44,
- 0x06, 0x00, 0x70, 0xB4, 0x42, 0xCD, 0x13, 0x72, 0x05, 0xBB, 0x00, 0x70, 0xEB, 0x76, 0xB4, 0x08,
- 0xCD, 0x13, 0x73, 0x0D, 0x5A, 0x84, 0xD2, 0x0F, 0x83, 0xD8, 0x00, 0xBE, 0x96, 0x7D, 0xE9, 0x82,
- 0x00, 0x66, 0x0F, 0xB6, 0xC6, 0x88, 0x64, 0xFF, 0x40, 0x66, 0x89, 0x44, 0x04, 0x0F, 0xB6, 0xD1,
- 0xC1, 0xE2, 0x02, 0x88, 0xE8, 0x88, 0xF4, 0x40, 0x89, 0x44, 0x08, 0x0F, 0xB6, 0xC2, 0xC0, 0xE8,
- 0x02, 0x66, 0x89, 0x04, 0x66, 0xA1, 0x60, 0x7C, 0x66, 0x09, 0xC0, 0x75, 0x4E, 0x66, 0xA1, 0x5C,
- 0x7C, 0x66, 0x31, 0xD2, 0x66, 0xF7, 0x34, 0x88, 0xD1, 0x31, 0xD2, 0x66, 0xF7, 0x74, 0x04, 0x3B,
- 0x44, 0x08, 0x7D, 0x37, 0xFE, 0xC1, 0x88, 0xC5, 0x30, 0xC0, 0xC1, 0xE8, 0x02, 0x08, 0xC1, 0x88,
- 0xD0, 0x5A, 0x88, 0xC6, 0xBB, 0x00, 0x70, 0x8E, 0xC3, 0x31, 0xDB, 0xB8, 0x01, 0x02, 0xCD, 0x13,
- 0x72, 0x1E, 0x8C, 0xC3, 0x60, 0x1E, 0xB9, 0x00, 0x01, 0x8E, 0xDB, 0x31, 0xF6, 0xBF, 0x00, 0x80,
- 0x8E, 0xC6, 0xFC, 0xF3, 0xA5, 0x1F, 0x61, 0xFF, 0x26, 0x5A, 0x7C, 0xBE, 0x93, 0x7D, 0xEB, 0x03,
- 0xBE, 0x99, 0x7D, 0xE8, 0x33, 0x00, 0xBE, 0x9C, 0x7D, 0xE8, 0x2D, 0x00, 0xCD, 0x18, 0xEB, 0xFE,
- 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58, 0x58,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x56, 0x54, 0x00, 0x47, 0x65, 0x00, 0x48, 0x44, 0x00, 0x52, 0x64, 0x00, 0x20, 0x45, 0x72, 0x0D,
- 0x0A, 0x00, 0xBB, 0x01, 0x00, 0xB4, 0x0E, 0xCD, 0x10, 0xAC, 0x3C, 0x00, 0x75, 0xF4, 0xC3, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};
initrd_info *g_initrd_img_list = NULL;
grub_memset(mbr, 0, 512);
grub_disk_read(disk, 0, 0, 512, mbr);
grub_disk_close(disk);
-
- g_check_mbr_data[92] = mbr[92];
- g_check_mbr_data[102] = mbr[102];
- g_check_mbr_data[103] = mbr[103];
- grub_memcpy(g_check_mbr_data + 0x180, mbr + 0x180, 16);
- if (grub_memcmp(g_check_mbr_data, mbr, 440))
+
+ if (grub_memcmp(g_check_mbr_data, mbr, 0x30) || grub_memcmp(g_check_mbr_data + 0x30, mbr + 0x190, 16))
{
return ventoy_set_check_result(12);
}
static g_ctl_req_t g_ventoy_config;
static g_dumpconf_t g_ventoy_dumpconf;
-static const char *g_ventoy_disk_uuid = NULL;
+static char g_ventoy_disk_uuid[64];
static bool g_ventoy_tasted = false;
static off_t g_ventoy_disk_size = 0;
static off_t g_disk_map_start = 0;
static off_t g_disk_map_end = 0;
+struct g_ventoy_map g_ventoy_map_data __attribute__((aligned (65536))) =
+{
+ { VENTOY_UNIX_SEG_MAGIC0, VENTOY_UNIX_SEG_MAGIC1, VENTOY_UNIX_SEG_MAGIC2, VENTOY_UNIX_SEG_MAGIC3 },
+ { 0, 0, 0, 0 },
+ 0, 0,
+ { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
+ { { 0, 0 } },
+ { VENTOY_UNIX_SEG_MAGIC0, VENTOY_UNIX_SEG_MAGIC1, VENTOY_UNIX_SEG_MAGIC2, VENTOY_UNIX_SEG_MAGIC3 }
+};
+
struct g_class g_ventoy_class = {
.name = G_VENTOY_CLASS_NAME,
.version = G_VERSION,
static bool g_vtoy_check_disk(struct g_class *mp, struct g_provider *pp)
{
int i;
+ bool ret = true;
uint8_t *buf;
char uuid[64];
const char *value;
struct g_consumer *cp;
struct g_geom *gp;
+ uint8_t mbrdata[] = {
+ 0xEB, 0x63, 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x56, 0x54, 0x00, 0x47, 0x65, 0x00, 0x48, 0x44, 0x00, 0x52, 0x64, 0x00, 0x20, 0x45, 0x72, 0x0D,
+ };
if (g_ventoy_disk_size == 0)
{
- if (resource_string_value("ventoy", 0, "disksize", &value) == 0)
+ if (VENTOY_MAP_VALID(g_ventoy_map_data.magic2))
{
- G_DEBUG("ventoy.disksize: %s\n", value);
- g_ventoy_disk_size = strtouq(value, NULL, 0);
+ G_DEBUG("ventoy map data is valid. [OK]\n");
+
+ for (i = 0; i < 16; i++)
+ {
+ sprintf(uuid + i * 2, "%02x", g_ventoy_map_data.diskuuid[i]);
+ }
+ snprintf(g_ventoy_disk_uuid, sizeof(g_ventoy_disk_uuid), "%s", uuid);
+ g_ventoy_disk_size = g_ventoy_map_data.disksize;
+
+ G_DEBUG("ventoy.disksize: %llu\n", (unsigned long long)g_ventoy_disk_size);
+ G_DEBUG("ventoy.diskuuid: <%s>\n", g_ventoy_disk_uuid);
}
-
- if (resource_string_value("ventoy", 0, "diskuuid", &g_ventoy_disk_uuid) == 0)
+ else
{
- G_DEBUG("ventoy.diskuuid: <%s>\n", g_ventoy_disk_uuid);
+ G_DEBUG("ventoy map data is invalid, get from resource\n");
+
+ if (resource_string_value("ventoy", 0, "disksize", &value) == 0)
+ {
+ G_DEBUG("ventoy.disksize: %s\n", value);
+ g_ventoy_disk_size = strtouq(value, NULL, 0);
+ }
+
+ if (resource_string_value("ventoy", 0, "diskuuid", &value) == 0)
+ {
+ snprintf(g_ventoy_disk_uuid, sizeof(g_ventoy_disk_uuid), "%s", value);
+ G_DEBUG("ventoy.diskuuid: <%s>\n", value);
+ }
}
}
{
sprintf(uuid + i * 2, "%02x", buf[0x180 + i]);
}
+
+ if (strncmp(g_ventoy_disk_uuid, uuid, 32))
+ {
+ ret = false;
+ }
+
+ if (memcmp(mbrdata, buf, 0x30) || memcmp(mbrdata + 0x30, buf + 0x190, 16))
+ {
+ ret = false;
+ }
+
g_free(buf);
-
- if (strncmp(g_ventoy_disk_uuid, uuid, 32) == 0)
+
+ if (ret)
{
- return true;
+ G_DEBUG("ventoy disk check OK\n");
}
- return false;
+ return ret;
}
static struct g_geom *
G_DEBUG("######### ventoy disk <%s> #############\n", pp->name);
- resource_int_value("ventoy", 0, "segnum", &disknum);
+ if (VENTOY_MAP_VALID(g_ventoy_map_data.magic2))
+ {
+ disknum = (int)g_ventoy_map_data.segnum;
+ G_DEBUG("segnum from map data is:<%d>\n", disknum);
+ }
+ else
+ {
+ resource_int_value("ventoy", 0, "segnum", &disknum);
+ G_DEBUG("segnum from resource is:<%d>\n", disknum);
+ }
strlcpy(md.md_magic, G_VENTOY_MAGIC, sizeof(md.md_magic));
md.md_version = G_VENTOY_VERSION;
for (i = 0; i < disknum; i ++)
{
- if (resource_string_value("ventoy", i, "seg", &value) == 0)
+ if (VENTOY_MAP_VALID(g_ventoy_map_data.magic2))
{
- g_disk_map_start = strtouq(value, &endpos, 0);
- g_disk_map_end = strtouq(endpos + 1, NULL, 0);
+ G_DEBUG("[map] ventoy segment%d: 0x%llx@0x%llx\n", i,
+ (long long)g_ventoy_map_data.seglist[i].seg_start_bytes,
+ (long long)g_ventoy_map_data.seglist[i].seg_end_bytes);
+
+ g_disk_map_start = (off_t)g_ventoy_map_data.seglist[i].seg_start_bytes;
+ g_disk_map_end = (off_t)g_ventoy_map_data.seglist[i].seg_end_bytes;
}
else
{
- printf("Failed to parse ventoy seg %d\n", i);
- continue;
+ if (resource_string_value("ventoy", i, "seg", &value) == 0)
+ {
+ g_disk_map_start = strtouq(value, &endpos, 0);
+ g_disk_map_end = strtouq(endpos + 1, NULL, 0);
+ }
+ else
+ {
+ printf("Failed to parse ventoy seg %d\n", i);
+ continue;
+ }
+ G_DEBUG("[resource] ventoy segment%d: %s\n", i, value);
}
-
- G_DEBUG("ventoy segment%d: %s\n", i, value);
G_VENTOY_DEBUG(1, "Adding disk %s to %s.", pp->name, gp->name);
error = g_ventoy_add_disk(sc, pp, i);