static void
loadBootOrder(void)
{
if (!CONFIG_BOOTORDER)
return;
char *f = romfile_loadfile("bootorder", NULL);
if (!f)
return;
int i = 0;
BootorderCount = 1;
while (f[i]) {
if (f[i] == '\n')
BootorderCount++;
i++;
}
Bootorder = malloc_tmphigh(BootorderCount*sizeof(char*));
if (!Bootorder) {
warn_noalloc();
free(f);
BootorderCount = 0;
return;
}
dprintf(1, "boot order:\n");
i = 0;
do {
Bootorder[i] = f;
f = strchr(f, '\n');
if (f)
*(f++) = '\0';
Bootorder[i] = nullTrailingSpace(Bootorder[i]);
dprintf(1, "%d: %s\n", i+1, Bootorder[i]);
i++;
} while (f);
}
// Validate drive, find block size / sector count, and register drive.
int
scsi_init_drive(struct drive_s *drive, const char *s, int prio)
{
struct disk_op_s dop;
memset(&dop, 0, sizeof(dop));
dop.drive_g = drive;
struct cdbres_inquiry data;
int ret = cdb_get_inquiry(&dop, &data);
if (ret)
return ret;
char vendor[sizeof(data.vendor)+1], product[sizeof(data.product)+1];
char rev[sizeof(data.rev)+1];
strtcpy(vendor, data.vendor, sizeof(vendor));
nullTrailingSpace(vendor);
strtcpy(product, data.product, sizeof(product));
nullTrailingSpace(product);
strtcpy(rev, data.rev, sizeof(rev));
nullTrailingSpace(rev);
int pdt = data.pdt & 0x1f;
int removable = !!(data.removable & 0x80);
dprintf(1, "%s vendor='%s' product='%s' rev='%s' type=%d removable=%d\n"
, s, vendor, product, rev, pdt, removable);
drive->removable = removable;
if (pdt == SCSI_TYPE_CDROM) {
drive->blksize = CDROM_SECTOR_SIZE;
drive->sectors = (u64)-1;
char *desc = znprintf(MAXDESCSIZE, "DVD/CD [%s Drive %s %s %s]"
, s, vendor, product, rev);
boot_add_cd(drive, desc, prio);
return 0;
}
ret = scsi_is_ready(&dop);
if (ret) {
dprintf(1, "scsi_is_ready returned %d\n", ret);
return ret;
}
struct cdbres_read_capacity capdata;
ret = cdb_read_capacity(&dop, &capdata);
if (ret)
return ret;
// READ CAPACITY returns the address of the last block.
// We do not bother with READ CAPACITY(16) because BIOS does not support
// 64-bit LBA anyway.
drive->blksize = be32_to_cpu(capdata.blksize);
if (drive->blksize != DISK_SECTOR_SIZE) {
dprintf(1, "%s: unsupported block size %d\n", s, drive->blksize);
return -1;
}
drive->sectors = (u64)be32_to_cpu(capdata.sectors) + 1;
dprintf(1, "%s blksize=%d sectors=%d\n"
, s, drive->blksize, (unsigned)drive->sectors);
// We do not recover from USB stalls, so try to be safe and avoid
// sending the command if the (obsolete, but still provided by QEMU)
// fixed disk geometry page may not be supported.
//
// We could also send the command only to small disks (e.g. <504MiB)
// but some old USB keys only support a very small subset of SCSI which
// does not even include the MODE SENSE command!
//
if (! CONFIG_COREBOOT && memcmp(vendor, "QEMU", 5) == 0) {
struct cdbres_mode_sense_geom geomdata;
ret = cdb_mode_sense_geom(&dop, &geomdata);
if (ret == 0) {
u32 cylinders;
cylinders = geomdata.cyl[0] << 16;
cylinders |= geomdata.cyl[1] << 8;
cylinders |= geomdata.cyl[2];
if (cylinders && geomdata.heads &&
drive->sectors <= 0xFFFFFFFFULL &&
((u32)drive->sectors % (geomdata.heads * cylinders) == 0)) {
drive->pchs.cylinders = cylinders;
drive->pchs.heads = geomdata.heads;
drive->pchs.spt = (u32)drive->sectors / (geomdata.heads * cylinders);
}
}
}
char *desc = znprintf(MAXDESCSIZE, "%s Drive %s %s %s"
, s, vendor, product, rev);
boot_add_hd(drive, desc, prio);
return 0;
}
