diff options
Diffstat (limited to 'contrib/syslinux/latest/memdisk/setup.c')
| -rw-r--r-- | contrib/syslinux/latest/memdisk/setup.c | 1189 |
1 files changed, 0 insertions, 1189 deletions
diff --git a/contrib/syslinux/latest/memdisk/setup.c b/contrib/syslinux/latest/memdisk/setup.c deleted file mode 100644 index 3f69cd3..0000000 --- a/contrib/syslinux/latest/memdisk/setup.c +++ /dev/null @@ -1,1189 +0,0 @@ -/* ----------------------------------------------------------------------- * - * - * Copyright 2001-2009 H. Peter Anvin - All Rights Reserved - * Copyright 2009-2010 Intel Corporation; author: H. Peter Anvin - * Portions copyright 2009-2010 Shao Miller - * [El Torito code, mBFT, "safe hook"] - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation, Inc., 53 Temple Place Ste 330, - * Boston MA 02111-1307, USA; either version 2 of the License, or - * (at your option) any later version; incorporated herein by reference. - * - * ----------------------------------------------------------------------- */ - -#include <stdint.h> -#include "bda.h" -#include "dskprobe.h" -#include "e820.h" -#include "conio.h" -#include "version.h" -#include "memdisk.h" -#include "../version.h" - -const char memdisk_version[] = "MEMDISK " VERSION_STR " " DATE; -const char copyright[] = - "Copyright " FIRSTYEAR "-" YEAR_STR " H. Peter Anvin et al"; - -extern const char _binary_memdisk_chs_512_bin_start[]; -extern const char _binary_memdisk_chs_512_bin_end[]; -extern const char _binary_memdisk_chs_512_bin_size[]; -extern const char _binary_memdisk_edd_512_bin_start[]; -extern const char _binary_memdisk_edd_512_bin_end[]; -extern const char _binary_memdisk_edd_512_bin_size[]; -extern const char _binary_memdisk_iso_512_bin_start[]; -extern const char _binary_memdisk_iso_512_bin_end[]; -extern const char _binary_memdisk_iso_512_bin_size[]; -extern const char _binary_memdisk_iso_2048_bin_start[]; -extern const char _binary_memdisk_iso_2048_bin_end[]; -extern const char _binary_memdisk_iso_2048_bin_size[]; - -/* Pull in structures common to MEMDISK and MDISKCHK.COM */ -#include "mstructs.h" - -/* An EDD disk packet */ -struct edd_dsk_pkt { - uint8_t size; /* Packet size */ - uint8_t res1; /* Reserved */ - uint16_t count; /* Count to transfer */ - uint32_t buf; /* Buffer pointer */ - uint64_t start; /* LBA to start from */ - uint64_t buf64; /* 64-bit buf pointer */ -} __attribute__ ((packed)); - -/* Change to 1 for El Torito debugging */ -#define DBG_ELTORITO 0 - -#if DBG_ELTORITO -extern void eltorito_dump(uint32_t); -#endif - -/* - * Routine to seek for a command-line item and return a pointer - * to the data portion, if present - */ - -/* Magic return values */ -#define CMD_NOTFOUND ((char *)-1) /* Not found */ -#define CMD_BOOL ((char *)-2) /* Found boolean option */ -#define CMD_HASDATA(X) ((int)(X) >= 0) - -static const char *getcmditem(const char *what) -{ - const char *p; - const char *wp = what; - int match = 0; - - for (p = shdr->cmdline; *p; p++) { - switch (match) { - case 0: /* Ground state */ - if (*p == ' ') - break; - - wp = what; - match = 1; - /* Fall through */ - - case 1: /* Matching */ - if (*wp == '\0') { - if (*p == '=') - return p + 1; - else if (*p == ' ') - return CMD_BOOL; - else { - match = 2; - break; - } - } - if (*p != *wp++) - match = 2; - break; - - case 2: /* Mismatch, skip rest of option */ - if (*p == ' ') - match = 0; /* Next option */ - break; - } - } - - /* Check for matching string at end of line */ - if (match == 1 && *wp == '\0') - return CMD_BOOL; - - return CMD_NOTFOUND; -} - -/* - * Check to see if this is a gzip image - */ -#define UNZIP_ALIGN 512 - -extern void _end; /* Symbol signalling end of data */ - -void unzip_if_needed(uint32_t * where_p, uint32_t * size_p) -{ - uint32_t where = *where_p; - uint32_t size = *size_p; - uint32_t zbytes; - uint32_t startrange, endrange; - uint32_t gzdatasize, gzwhere; - uint32_t orig_crc, offset; - uint32_t target = 0; - int i, okmem; - - /* Is it a gzip image? */ - if (check_zip((void *)where, size, &zbytes, &gzdatasize, - &orig_crc, &offset) == 0) { - - if (offset + zbytes > size) { - /* - * Assertion failure; check_zip is supposed to guarantee this - * never happens. - */ - die("internal error: check_zip returned nonsense\n"); - } - - /* - * Find a good place to put it: search memory ranges in descending - * order until we find one that is legal and fits - */ - okmem = 0; - for (i = nranges - 1; i >= 0; i--) { - /* - * We can't use > 4G memory (32 bits only.) Truncate to 2^32-1 - * so we don't have to deal with funny wraparound issues. - */ - - /* Must be memory */ - if (ranges[i].type != 1) - continue; - - /* Range start */ - if (ranges[i].start >= 0xFFFFFFFF) - continue; - - startrange = (uint32_t) ranges[i].start; - - /* Range end (0 for end means 2^64) */ - endrange = ((ranges[i + 1].start >= 0xFFFFFFFF || - ranges[i + 1].start == 0) - ? 0xFFFFFFFF : (uint32_t) ranges[i + 1].start); - - /* Make sure we don't overwrite ourselves */ - if (startrange < (uint32_t) & _end) - startrange = (uint32_t) & _end; - - /* Allow for alignment */ - startrange = - (ranges[i].start + (UNZIP_ALIGN - 1)) & ~(UNZIP_ALIGN - 1); - - /* In case we just killed the whole range... */ - if (startrange >= endrange) - continue; - - /* - * Must be large enough... don't rely on gzwhere for this - * (wraparound) - */ - if (endrange - startrange < gzdatasize) - continue; - - /* - * This is where the gz image would be put if we put it in this - * range... - */ - gzwhere = (endrange - gzdatasize) & ~(UNZIP_ALIGN - 1); - - /* Cast to uint64_t just in case we're flush with the top byte */ - if ((uint64_t) where + size >= gzwhere && where < endrange) { - /* - * Need to move source data to avoid compressed/uncompressed - * overlap - */ - uint32_t newwhere; - - if (gzwhere - startrange < size) - continue; /* Can't fit both old and new */ - - newwhere = (gzwhere - size) & ~(UNZIP_ALIGN - 1); - printf("Moving compressed data from 0x%08x to 0x%08x\n", - where, newwhere); - - memmove((void *)newwhere, (void *)where, size); - where = newwhere; - } - - target = gzwhere; - okmem = 1; - break; - } - - if (!okmem) - die("Not enough memory to decompress image (need 0x%08x bytes)\n", - gzdatasize); - - printf("gzip image: decompressed addr 0x%08x, len 0x%08x: ", - target, gzdatasize); - - *size_p = gzdatasize; - *where_p = (uint32_t) unzip((void *)(where + offset), zbytes, - gzdatasize, orig_crc, (void *)target); - } -} - -/* - * Figure out the "geometry" of the disk in question - */ -struct geometry { - uint32_t sectors; /* Sector count */ - uint32_t c, h, s; /* C/H/S geometry */ - uint32_t offset; /* Byte offset for disk */ - uint32_t boot_lba; /* LBA of bootstrap code */ - uint8_t type; /* Type byte for INT 13h AH=08h */ - uint8_t driveno; /* Drive no */ - uint8_t sector_shift; /* Sector size as a power of 2 */ - const char *hsrc, *ssrc; /* Origins of H and S geometries */ -}; - -/* Format of a DOS partition table entry */ -struct ptab_entry { - uint8_t active; - uint8_t start_h, start_s, start_c; - uint8_t type; - uint8_t end_h, end_s, end_c; - uint32_t start; - uint32_t size; -} __attribute__ ((packed)); - -/* Format of a FAT filesystem superblock */ -struct fat_extra { - uint8_t bs_drvnum; - uint8_t bs_resv1; - uint8_t bs_bootsig; - uint32_t bs_volid; - char bs_vollab[11]; - char bs_filsystype[8]; -} __attribute__ ((packed)); -struct fat_super { - uint8_t bs_jmpboot[3]; - char bs_oemname[8]; - uint16_t bpb_bytspersec; - uint8_t bpb_secperclus; - uint16_t bpb_rsvdseccnt; - uint8_t bpb_numfats; - uint16_t bpb_rootentcnt; - uint16_t bpb_totsec16; - uint8_t bpb_media; - uint16_t bpb_fatsz16; - uint16_t bpb_secpertrk; - uint16_t bpb_numheads; - uint32_t bpb_hiddsec; - uint32_t bpb_totsec32; - union { - struct { - struct fat_extra extra; - } fat16; - struct { - uint32_t bpb_fatsz32; - uint16_t bpb_extflags; - uint16_t bpb_fsver; - uint32_t bpb_rootclus; - uint16_t bpb_fsinfo; - uint16_t bpb_bkbootsec; - char bpb_reserved[12]; - /* Clever, eh? Same fields, different offset... */ - struct fat_extra extra; - } fat32 __attribute__ ((packed)); - } x; -} __attribute__ ((packed)); - -/* Format of a DOSEMU header */ -struct dosemu_header { - uint8_t magic[7]; /* DOSEMU\0 */ - uint32_t h; - uint32_t s; - uint32_t c; - uint32_t offset; - uint8_t pad[105]; -} __attribute__ ((packed)); - -#define FOUR(a,b,c,d) (((a) << 24)|((b) << 16)|((c) << 8)|(d)) - -static const struct geometry *get_disk_image_geometry(uint32_t where, - uint32_t size) -{ - static struct geometry hd_geometry; - struct dosemu_header dosemu; - unsigned int sectors, xsectors, v; - unsigned int offset; - int i; - const char *p; - - printf("command line: %s\n", shdr->cmdline); - - hd_geometry.sector_shift = 9; /* Assume floppy/HDD at first */ - - offset = 0; - if (CMD_HASDATA(p = getcmditem("offset")) && (v = atou(p))) - offset = v; - - sectors = xsectors = (size - offset) >> hd_geometry.sector_shift; - - hd_geometry.hsrc = "guess"; - hd_geometry.ssrc = "guess"; - hd_geometry.sectors = sectors; - hd_geometry.offset = offset; - - if ((p = getcmditem("iso")) != CMD_NOTFOUND) { -#if DBG_ELTORITO - eltorito_dump(where); -#endif - struct edd4_bvd *bvd = (struct edd4_bvd *)(where + 17 * 2048); - /* Tiny sanity check */ - if ((bvd->boot_rec_ind != 0) || (bvd->ver != 1)) - printf("El Torito BVD sanity check failed.\n"); - struct edd4_bootcat *boot_cat = - (struct edd4_bootcat *)(where + bvd->boot_cat * 2048); - /* Another tiny sanity check */ - if ((boot_cat->validation_entry.platform_id != 0) || - (boot_cat->validation_entry.key55 != 0x55) || - (boot_cat->validation_entry.keyAA != 0xAA)) - printf("El Torito boot catalog sanity check failed.\n"); - /* If we have an emulation mode, set the offset to the image */ - if (boot_cat->initial_entry.media_type) - hd_geometry.offset += boot_cat->initial_entry.load_block * 2048; - else - /* We're a no-emulation mode, so we will boot to an offset */ - hd_geometry.boot_lba = boot_cat->initial_entry.load_block * 4; - if (boot_cat->initial_entry.media_type < 4) { - /* We're a floppy emulation mode or our params will be - * overwritten by the no emulation mode case - */ - hd_geometry.driveno = 0x00; - hd_geometry.c = 80; - hd_geometry.h = 2; - } - switch (boot_cat->initial_entry.media_type) { - case 0: /* No emulation */ - hd_geometry.driveno = 0xE0; - hd_geometry.type = 10; /* ATAPI removable media device */ - hd_geometry.c = 65535; - hd_geometry.h = 255; - hd_geometry.s = 15; - /* 2048-byte sectors, so adjust the size and count */ - hd_geometry.sector_shift = 11; - break; - case 1: /* 1.2 MB floppy */ - hd_geometry.s = 15; - hd_geometry.type = 2; - sectors = 2400; - break; - case 2: /* 1.44 MB floppy */ - hd_geometry.s = 18; - hd_geometry.type = 4; - sectors = 2880; - break; - case 3: /* 2.88 MB floppy */ - hd_geometry.s = 36; - hd_geometry.type = 6; - sectors = 5760; - break; - case 4: - hd_geometry.driveno = 0x80; - hd_geometry.type = 0; - break; - } - sectors = (size - hd_geometry.offset) >> hd_geometry.sector_shift; - - /* For HDD emulation, we figure out the geometry later. Otherwise: */ - if (hd_geometry.s) { - hd_geometry.hsrc = hd_geometry.ssrc = "El Torito"; - } - hd_geometry.sectors = sectors; - } - - /* Do we have a DOSEMU header? */ - memcpy(&dosemu, (char *)where + hd_geometry.offset, sizeof dosemu); - if (!memcmp("DOSEMU", dosemu.magic, 7)) { - /* Always a hard disk unless overruled by command-line options */ - hd_geometry.driveno = 0x80; - hd_geometry.type = 0; - hd_geometry.c = dosemu.c; - hd_geometry.h = dosemu.h; - hd_geometry.s = dosemu.s; - hd_geometry.offset += dosemu.offset; - sectors = (size - hd_geometry.offset) >> hd_geometry.sector_shift; - - hd_geometry.hsrc = hd_geometry.ssrc = "DOSEMU"; - } - - if (CMD_HASDATA(p = getcmditem("c")) && (v = atou(p))) - hd_geometry.c = v; - if (CMD_HASDATA(p = getcmditem("h")) && (v = atou(p))) { - hd_geometry.h = v; - hd_geometry.hsrc = "cmd"; - } - if (CMD_HASDATA(p = getcmditem("s")) && (v = atou(p))) { - hd_geometry.s = v; - hd_geometry.ssrc = "cmd"; - } - - if (!hd_geometry.h || !hd_geometry.s) { - int h, s, max_h, max_s; - - max_h = hd_geometry.h; - max_s = hd_geometry.s; - - if (!(max_h | max_s)) { - /* Look for a FAT superblock and if we find something that looks - enough like one, use geometry from that. This takes care of - megafloppy images and unpartitioned hard disks. */ - const struct fat_extra *extra = NULL; - const struct fat_super *fs = (const struct fat_super *) - ((char *)where + hd_geometry.offset); - - if ((fs->bpb_media == 0xf0 || fs->bpb_media >= 0xf8) && - (fs->bs_jmpboot[0] == 0xe9 || fs->bs_jmpboot[0] == 0xeb) && - fs->bpb_bytspersec == 512 && - fs->bpb_numheads >= 1 && fs->bpb_numheads <= 256 && - fs->bpb_secpertrk >= 1 && fs->bpb_secpertrk <= 63) { - extra = - fs->bpb_fatsz16 ? &fs->x.fat16.extra : &fs->x.fat32.extra; - if (! - (extra->bs_bootsig == 0x29 && extra->bs_filsystype[0] == 'F' - && extra->bs_filsystype[1] == 'A' - && extra->bs_filsystype[2] == 'T')) - extra = NULL; - } - if (extra) { - hd_geometry.driveno = extra->bs_drvnum & 0x80; - max_h = fs->bpb_numheads; - max_s = fs->bpb_secpertrk; - hd_geometry.hsrc = hd_geometry.ssrc = "FAT"; - } - } - - if (!(max_h | max_s)) { - /* No FAT filesystem found to steal geometry from... */ - if ((sectors < 4096 * 2) && (hd_geometry.sector_shift == 9)) { - int ok = 0; - unsigned int xsectors = sectors; - - hd_geometry.driveno = 0; /* Assume floppy */ - - while (!ok) { - /* Assume it's a floppy drive, guess a geometry */ - unsigned int type, track; - int c, h, s = 0; - - if (xsectors < 320 * 2) { - c = 40; - h = 1; - type = 1; - } else if (xsectors < 640 * 2) { - c = 40; - h = 2; - type = 1; - } else if (xsectors < 1200 * 2) { - c = 80; - h = 2; - type = 3; - } else if (xsectors < 1440 * 2) { - c = 80; - h = 2; - type = 2; - } else if (xsectors < 2880 * 2) { - c = 80; - h = 2; - type = 4; - } else { - c = 80; - h = 2; - type = 6; - } - track = c * h; - while (c < 256) { - s = xsectors / track; - if (s < 63 && (xsectors % track) == 0) { - ok = 1; - break; - } - c++; - track += h; - } - if (ok) { - max_h = h; - max_s = s; - hd_geometry.hsrc = hd_geometry.ssrc = "fd"; - } else { - /* No valid floppy geometry, fake it by simulating broken - sectors at the end of the image... */ - xsectors++; - } - } - } else { - /* Assume it is a hard disk image and scan for a partition table */ - const struct ptab_entry *ptab = (const struct ptab_entry *) - ((char *)where + hd_geometry.offset + (512 - 2 - 4 * 16)); - - /* Assume hard disk */ - if (!hd_geometry.driveno) - hd_geometry.driveno = 0x80; - - if (*(uint16_t *) ((char *)where + hd_geometry.offset + 512 - 2) == 0xaa55) { - for (i = 0; i < 4; i++) { - if (ptab[i].type && !(ptab[i].active & 0x7f)) { - s = (ptab[i].start_s & 0x3f); - h = ptab[i].start_h + 1; - - if (max_h < h) - max_h = h; - if (max_s < s) - max_s = s; - - s = (ptab[i].end_s & 0x3f); - h = ptab[i].end_h + 1; - - if (max_h < h) { - max_h = h; - hd_geometry.hsrc = "MBR"; - } - if (max_s < s) { - max_s = s; - hd_geometry.ssrc = "MBR"; - } - } - } - } - } - } - - if (!max_h) - max_h = xsectors > 2097152 ? 255 : 64; - if (!max_s) - max_s = xsectors > 2097152 ? 63 : 32; - - hd_geometry.h = max_h; - hd_geometry.s = max_s; - } - - if (!hd_geometry.c) - hd_geometry.c = xsectors / (hd_geometry.h * hd_geometry.s); - - if ((p = getcmditem("floppy")) != CMD_NOTFOUND) { - hd_geometry.driveno = CMD_HASDATA(p) ? atou(p) & 0x7f : 0; - } else if ((p = getcmditem("harddisk")) != CMD_NOTFOUND) { - hd_geometry.driveno = CMD_HASDATA(p) ? atou(p) | 0x80 : 0x80; - } - - if (hd_geometry.driveno & 0x80) { - hd_geometry.type = 0; /* Type = hard disk */ - } else { - if (hd_geometry.type == 0) - hd_geometry.type = 0x10; /* ATAPI floppy, e.g. LS-120 */ - } - - if ((size - hd_geometry.offset) & 0x1ff) { - puts("MEMDISK: Image has fractional end sector\n"); - } - if (sectors % (hd_geometry.h * hd_geometry.s)) { - puts("MEMDISK: Image seems to have fractional end cylinder\n"); - } - if ((hd_geometry.c * hd_geometry.h * hd_geometry.s) > sectors) { - puts("MEMDISK: Image appears to be truncated\n"); - } - - return &hd_geometry; -} - -/* - * Find a $PnP installation check structure; return (ES << 16) + DI value - */ -static uint32_t pnp_install_check(void) -{ - uint32_t *seg; - unsigned char *p, csum; - int i, len; - - for (seg = (uint32_t *) 0xf0000; seg < (uint32_t *) 0x100000; seg += 4) { - if (*seg == ('$' + ('P' << 8) + ('n' << 16) + ('P' << 24))) { - p = (unsigned char *)seg; - len = p[5]; - if (len < 0x21) - continue; - csum = 0; - for (i = len; i; i--) - csum += *p++; - if (csum != 0) - continue; - - return (0xf000 << 16) + (uint16_t) (unsigned long)seg; - } - } - - return 0; -} - -/* - * Relocate the real-mode code to a new segment - */ -struct gdt_ptr { - uint16_t limit; - uint32_t base; -} __attribute__ ((packed)); - -static void set_seg_base(uint32_t gdt_base, int seg, uint32_t v) -{ - *(uint16_t *) (gdt_base + seg + 2) = v; - *(uint8_t *) (gdt_base + seg + 4) = v >> 16; - *(uint8_t *) (gdt_base + seg + 7) = v >> 24; -} - -static void relocate_rm_code(uint32_t newbase) -{ - uint32_t gdt_base; - uint32_t oldbase = rm_args.rm_base; - uint32_t delta = newbase - oldbase; - - cli(); - memmove((void *)newbase, (void *)oldbase, rm_args.rm_size); - - rm_args.rm_return += delta; - rm_args.rm_intcall += delta; - rm_args.rm_bounce += delta; - rm_args.rm_base += delta; - rm_args.rm_gdt += delta; - rm_args.rm_pmjmp += delta; - rm_args.rm_rmjmp += delta; - - gdt_base = rm_args.rm_gdt; - - *(uint32_t *) (gdt_base + 2) = gdt_base; /* GDT self-pointer */ - - /* Segments 0x10 and 0x18 are real-mode-based */ - set_seg_base(gdt_base, 0x10, rm_args.rm_base); - set_seg_base(gdt_base, 0x18, rm_args.rm_base); - - asm volatile ("lgdtl %0"::"m" (*(char *)gdt_base)); - - *(uint32_t *) rm_args.rm_pmjmp += delta; - *(uint16_t *) rm_args.rm_rmjmp += delta >> 4; - - rm_args.rm_handle_interrupt += delta; - - sti(); -} - -static uint8_t checksum_buf(const void *buf, int count) -{ - const uint8_t *p = buf; - uint8_t c = 0; - - while (count--) - c += *p++; - - return c; -} - -static int stack_needed(void) -{ - const unsigned int min_stack = 128; /* Minimum stack size */ - const unsigned int def_stack = 512; /* Default stack size */ - unsigned int v = 0; - const char *p; - - if (CMD_HASDATA(p = getcmditem("stack"))) - v = atou(p); - - if (!v) - v = def_stack; - - if (v < min_stack) - v = min_stack; - - return v; -} - -struct real_mode_args rm_args; - -/* - * Actual setup routine - * Returns the drive number (which is then passed in %dl to the - * called routine.) - */ -void setup(const struct real_mode_args *rm_args_ptr) -{ - unsigned int bin_size; - char *memdisk_hook; - struct memdisk_header *hptr; - struct patch_area *pptr; - struct mBFT *mbft; - uint16_t driverseg; - uint32_t driverptr, driveraddr; - uint16_t dosmem_k; - uint32_t stddosmem; - const struct geometry *geometry; - unsigned int total_size; - unsigned int cmdline_len, stack_len, e820_len; - const struct edd4_bvd *bvd; - const struct edd4_bootcat *boot_cat = 0; - com32sys_t regs; - uint32_t ramdisk_image, ramdisk_size; - uint32_t boot_base, rm_base; - int bios_drives; - int do_edd = 1; /* 0 = no, 1 = yes, default is yes */ - int do_eltorito = 0; /* default is no */ - int no_bpt; /* No valid BPT presented */ - uint32_t boot_seg = 0; /* Meaning 0000:7C00 */ - uint32_t boot_len = 512; /* One sector */ - - /* We need to copy the rm_args into their proper place */ - memcpy(&rm_args, rm_args_ptr, sizeof rm_args); - sti(); /* ... then interrupts are safe */ - - /* Show signs of life */ - printf("%s %s\n", memdisk_version, copyright); - - if (!shdr->ramdisk_image || !shdr->ramdisk_size) - die("MEMDISK: No ramdisk image specified!\n"); - - ramdisk_image = shdr->ramdisk_image; - ramdisk_size = shdr->ramdisk_size; - - e820map_init(); /* Initialize memory data structure */ - get_mem(); /* Query BIOS for memory map */ - parse_mem(); /* Parse memory map */ - - printf("Ramdisk at 0x%08x, length 0x%08x\n", ramdisk_image, ramdisk_size); - - unzip_if_needed(&ramdisk_image, &ramdisk_size); - - geometry = get_disk_image_geometry(ramdisk_image, ramdisk_size); - - if (getcmditem("edd") != CMD_NOTFOUND || - getcmditem("ebios") != CMD_NOTFOUND) - do_edd = 1; - else if (getcmditem("noedd") != CMD_NOTFOUND || - getcmditem("noebios") != CMD_NOTFOUND || - getcmditem("cbios") != CMD_NOTFOUND) - do_edd = 0; - else - do_edd = (geometry->driveno & 0x80) ? 1 : 0; - - if (getcmditem("iso") != CMD_NOTFOUND) { - do_eltorito = 1; - do_edd = 1; /* Mandatory */ - } - - /* Choose the appropriate installable memdisk hook */ - if (do_eltorito) { - if (geometry->sector_shift == 11) { - bin_size = (int)&_binary_memdisk_iso_2048_bin_size; - memdisk_hook = (char *)&_binary_memdisk_iso_2048_bin_start; - } else { - bin_size = (int)&_binary_memdisk_iso_512_bin_size; - memdisk_hook = (char *)&_binary_memdisk_iso_512_bin_start; - } - } else { - if (do_edd) { - bin_size = (int)&_binary_memdisk_edd_512_bin_size; - memdisk_hook = (char *)&_binary_memdisk_edd_512_bin_start; - } else { - bin_size = (int)&_binary_memdisk_chs_512_bin_size; - memdisk_hook = (char *)&_binary_memdisk_chs_512_bin_start; - } - } - - /* Reserve the ramdisk memory */ - insertrange(ramdisk_image, ramdisk_size, 2); - parse_mem(); /* Recompute variables */ - - /* Figure out where it needs to go */ - hptr = (struct memdisk_header *)memdisk_hook; - pptr = (struct patch_area *)(memdisk_hook + hptr->patch_offs); - - dosmem_k = rdz_16(BIOS_BASEMEM); - pptr->mdi.olddosmem = dosmem_k; - stddosmem = dosmem_k << 10; - /* If INT 15 E820 and INT 12 disagree, go with the most conservative */ - if (stddosmem > dos_mem) - stddosmem = dos_mem; - - pptr->driveno = geometry->driveno; - pptr->drivetype = geometry->type; - pptr->cylinders = geometry->c; /* Possible precision loss */ - pptr->heads = geometry->h; - pptr->sectors = geometry->s; - pptr->mdi.disksize = geometry->sectors; - pptr->mdi.diskbuf = ramdisk_image + geometry->offset; - pptr->mdi.sector_shift = geometry->sector_shift; - pptr->statusptr = (geometry->driveno & 0x80) ? 0x474 : 0x441; - - pptr->mdi.bootloaderid = shdr->type_of_loader; - - pptr->configflags = CONFIG_SAFEINT; /* Default */ - /* Set config flags */ - if (getcmditem("ro") != CMD_NOTFOUND) { - pptr->configflags |= CONFIG_READONLY; - } - if (getcmditem("raw") != CMD_NOTFOUND) { - pptr->configflags &= ~CONFIG_MODEMASK; - pptr->configflags |= CONFIG_RAW; - } - if (getcmditem("bigraw") != CMD_NOTFOUND) { - pptr->configflags &= ~CONFIG_MODEMASK; - pptr->configflags |= CONFIG_BIGRAW | CONFIG_RAW; - } - if (getcmditem("int") != CMD_NOTFOUND) { - pptr->configflags &= ~CONFIG_MODEMASK; - /* pptr->configflags |= 0; */ - } - if (getcmditem("safeint") != CMD_NOTFOUND) { - pptr->configflags &= ~CONFIG_MODEMASK; - pptr->configflags |= CONFIG_SAFEINT; - } - - printf("Disk is %s%d, %u%s K, C/H/S = %u/%u/%u (%s/%s), EDD %s, %s\n", - (geometry->driveno & 0x80) ? "hd" : "fd", - geometry->driveno & 0x7f, - geometry->sectors >> 1, - (geometry->sectors & 1) ? ".5" : "", - geometry->c, geometry->h, geometry->s, - geometry->hsrc, geometry->ssrc, - do_edd ? "on" : "off", - pptr->configflags & CONFIG_READONLY ? "ro" : "rw"); - - puts("Using "); - switch (pptr->configflags & CONFIG_MODEMASK) { - case 0: - puts("standard INT 15h"); - break; - case CONFIG_SAFEINT: - puts("safe INT 15h"); - break; - case CONFIG_RAW: - puts("raw"); - break; - case CONFIG_RAW | CONFIG_BIGRAW: - puts("big real mode raw"); - break; - default: - printf("unknown %#x", pptr->configflags & CONFIG_MODEMASK); - break; - } - puts(" access to high memory\n"); - - /* Set up a drive parameter table */ - if (geometry->driveno & 0x80) { - /* Hard disk */ - pptr->dpt.hd.max_cyl = geometry->c - 1; - pptr->dpt.hd.max_head = geometry->h - 1; - pptr->dpt.hd.ctrl = (geometry->h > 8) ? 0x08 : 0; - } else { - /* Floppy - most of these fields are bogus and mimic - a 1.44 MB floppy drive */ - pptr->dpt.fd.specify1 = 0xdf; - pptr->dpt.fd.specify2 = 0x02; - pptr->dpt.fd.delay = 0x25; - pptr->dpt.fd.sectors = geometry->s; - pptr->dpt.fd.bps = 0x02; - pptr->dpt.fd.isgap = 0x12; - pptr->dpt.fd.dlen = 0xff; - pptr->dpt.fd.fgap = 0x6c; - pptr->dpt.fd.ffill = 0xf6; - pptr->dpt.fd.settle = 0x0f; - pptr->dpt.fd.mstart = 0x05; - pptr->dpt.fd.maxtrack = geometry->c - 1; - pptr->dpt.fd.cmos = geometry->type > 5 ? 5 : geometry->type; - - pptr->dpt.fd.old_fd_dpt = rdz_32(BIOS_INT1E); - } - - /* Set up an EDD drive parameter table */ - if (do_edd) { - pptr->edd_dpt.sectors = geometry->sectors; - /* The EDD spec has this as <= 15482880 sectors (1024x240x63); - this seems to make very little sense. Try for something saner. */ - if (geometry->c <= 1024 && geometry->h <= 255 && geometry->s <= 63) { - pptr->edd_dpt.c = geometry->c; - pptr->edd_dpt.h = geometry->h; - pptr->edd_dpt.s = geometry->s; - /* EDD-4 states that invalid geometry should be returned - * for INT 0x13, AH=0x48 "EDD Get Disk Parameters" call on an - * El Torito ODD. Check for 2048-byte sector size - */ - if (geometry->sector_shift != 11) - pptr->edd_dpt.flags |= 0x0002; /* Geometry valid */ - } - if (!(geometry->driveno & 0x80)) { - /* Floppy drive. Mark it as a removable device with - media change notification; media is present. */ - pptr->edd_dpt.flags |= 0x0014; - } - - pptr->edd_dpt.devpath[0] = pptr->mdi.diskbuf; - pptr->edd_dpt.chksum = -checksum_buf(&pptr->edd_dpt.dpikey, 73 - 30); - } - - if (do_eltorito) { - bvd = (struct edd4_bvd *)(ramdisk_image + 17 * 2048); - boot_cat = - (struct edd4_bootcat *)(ramdisk_image + bvd->boot_cat * 2048); - pptr->cd_pkt.type = boot_cat->initial_entry.media_type; /* Cheat */ - pptr->cd_pkt.driveno = geometry->driveno; - pptr->cd_pkt.start = boot_cat->initial_entry.load_block; - boot_seg = pptr->cd_pkt.load_seg = boot_cat->initial_entry.load_seg; - pptr->cd_pkt.sect_count = boot_cat->initial_entry.sect_count; - boot_len = pptr->cd_pkt.sect_count * 512; - pptr->cd_pkt.geom1 = (uint8_t)(pptr->cylinders) & 0xFF; - pptr->cd_pkt.geom2 = - (uint8_t)(pptr->sectors) | (uint8_t)((pptr->cylinders >> 2) & 0xC0); - pptr->cd_pkt.geom3 = (uint8_t)(pptr->heads); - } - - /* The size is given by hptr->total_size plus the size of the E820 - map -- 12 bytes per range; we may need as many as 2 additional - ranges (each insertrange() can worst-case turn 1 area into 3) - plus the terminating range, over what nranges currently show. */ - total_size = hptr->total_size; /* Actual memdisk code */ - e820_len = (nranges + 3) * sizeof(ranges[0]); - total_size += e820_len; /* E820 memory ranges */ - cmdline_len = strlen(shdr->cmdline) + 1; - total_size += cmdline_len; /* Command line */ - stack_len = stack_needed(); - total_size += stack_len; /* Stack */ - printf("Code %u, meminfo %u, cmdline %u, stack %u\n", - hptr->total_size, e820_len, cmdline_len, stack_len); - printf("Total size needed = %u bytes, allocating %uK\n", - total_size, (total_size + 0x3ff) >> 10); - - if (total_size > dos_mem) - die("MEMDISK: Insufficient low memory\n"); - - driveraddr = stddosmem - total_size; - driveraddr &= ~0x3FF; - - printf("Old dos memory at 0x%05x (map says 0x%05x), loading at 0x%05x\n", - stddosmem, dos_mem, driveraddr); - - /* Reserve this range of memory */ - wrz_16(BIOS_BASEMEM, driveraddr >> 10); - insertrange(driveraddr, dos_mem - driveraddr, 2); - parse_mem(); - - pptr->mem1mb = low_mem >> 10; - pptr->mem16mb = high_mem >> 16; - if (low_mem == (15 << 20)) { - /* lowmem maxed out */ - uint32_t int1588mem = (high_mem >> 10) + (low_mem >> 10); - pptr->memint1588 = (int1588mem > 0xffff) ? 0xffff : int1588mem; - } else { - pptr->memint1588 = low_mem >> 10; - } - - printf("1588: 0x%04x 15E801: 0x%04x 0x%04x\n", - pptr->memint1588, pptr->mem1mb, pptr->mem16mb); - - driverseg = driveraddr >> 4; - driverptr = driverseg << 16; - - /* Anything beyond the end is for the stack */ - pptr->mystack = (uint16_t) (stddosmem - driveraddr); - - pptr->mdi.oldint13.uint32 = rdz_32(BIOS_INT13); - pptr->mdi.oldint15.uint32 = rdz_32(BIOS_INT15); - - /* Adjust the E820 table: if there are null ranges (type 0) - at the end, change them to type end of list (-1). - This is necessary for the driver to be able to report end - of list correctly. */ - while (nranges && ranges[nranges - 1].type == 0) { - ranges[--nranges].type = -1; - } - - if (getcmditem("nopassany") != CMD_NOTFOUND) { - printf("nopassany specified - we're the only drive of any kind\n"); - bios_drives = 0; - pptr->drivecnt = 0; - no_bpt = 1; - pptr->mdi.oldint13.uint32 = driverptr + hptr->iret_offs; - wrz_8(BIOS_EQUIP, rdz_8(BIOS_EQUIP) & ~0xc1); - wrz_8(BIOS_HD_COUNT, 0); - } else if (getcmditem("nopass") != CMD_NOTFOUND) { - printf("nopass specified - we're the only drive\n"); - bios_drives = 0; - pptr->drivecnt = 0; - no_bpt = 1; - } else { - /* Query drive parameters of this type */ - memset(®s, 0, sizeof regs); - regs.es = 0; - regs.eax.b[1] = 0x08; - regs.edx.b[0] = geometry->driveno & 0x80; - intcall(0x13, ®s, ®s); - - /* Note: per suggestion from the Interrupt List, consider - INT 13 08 to have failed if the sector count in CL is zero. */ - if ((regs.eflags.l & 1) || !(regs.ecx.b[0] & 0x3f)) { - printf("INT 13 08: Failure, assuming this is the only drive\n"); - pptr->drivecnt = 0; - no_bpt = 1; - } else { - printf("INT 13 08: Success, count = %u, BPT = %04x:%04x\n", - regs.edx.b[0], regs.es, regs.edi.w[0]); - pptr->drivecnt = regs.edx.b[0]; - no_bpt = !(regs.es | regs.edi.w[0]); - } - - /* Compare what INT 13h returned with the appropriate equipment byte */ - if (geometry->driveno & 0x80) { - bios_drives = rdz_8(BIOS_HD_COUNT); - } else { - uint8_t equip = rdz_8(BIOS_EQUIP); - - if (equip & 1) - bios_drives = (equip >> 6) + 1; - else - bios_drives = 0; - } - - if (pptr->drivecnt > bios_drives) { - printf("BIOS equipment byte says count = %d, go with that\n", - bios_drives); - pptr->drivecnt = bios_drives; - } - } - - /* Add ourselves to the drive count */ - pptr->drivecnt++; - - /* Discontiguous drive space. There is no really good solution for this. */ - if (pptr->drivecnt <= (geometry->driveno & 0x7f)) - pptr->drivecnt = (geometry->driveno & 0x7f) + 1; - - /* Probe for contiguous range of BIOS drives starting with driveno */ - pptr->driveshiftlimit = probe_drive_range(geometry->driveno) + 1; - if ((pptr->driveshiftlimit & 0x80) != (geometry->driveno & 0x80)) - printf("We lost the last drive in our class of drives.\n"); - printf("Drive probing gives drive shift limit: 0x%02x\n", - pptr->driveshiftlimit); - - /* Pointer to the command line */ - pptr->mdi.cmdline.seg_off.offset = bin_size + (nranges + 1) * sizeof(ranges[0]); - pptr->mdi.cmdline.seg_off.segment = driverseg; - - /* Copy driver followed by E820 table followed by command line */ - { - unsigned char *dpp = (unsigned char *)(driverseg << 4); - - /* Adjust these pointers to point to the installed image */ - /* Careful about the order here... the image isn't copied yet! */ - pptr = (struct patch_area *)(dpp + hptr->patch_offs); - hptr = (struct memdisk_header *)dpp; - - /* Actually copy to low memory */ - dpp = mempcpy(dpp, memdisk_hook, bin_size); - dpp = mempcpy(dpp, ranges, (nranges + 1) * sizeof(ranges[0])); - dpp = mempcpy(dpp, shdr->cmdline, cmdline_len); - } - - /* Note the previous INT 13h hook in the "safe hook" structure */ - hptr->safe_hook.old_hook.uint32 = pptr->mdi.oldint13.uint32; - - /* Re-fill the "safe hook" mBFT field with the physical address */ - mbft = (struct mBFT *)(((const char *)hptr) + hptr->safe_hook.mbft); - hptr->safe_hook.mbft = (size_t)mbft; - - /* Update various BIOS magic data areas (gotta love this shit) */ - - if (geometry->driveno & 0x80) { - /* Update BIOS hard disk count */ - uint8_t nhd = pptr->drivecnt; - - if (nhd > 128) - nhd = 128; - - if (!do_eltorito) - wrz_8(BIOS_HD_COUNT, nhd); - } else { - /* Update BIOS floppy disk count */ - uint8_t equip = rdz_8(BIOS_EQUIP); - uint8_t nflop = pptr->drivecnt; - - if (nflop > 4) /* Limit of equipment byte */ - nflop = 4; - - equip &= 0x3E; - if (nflop) - equip |= ((nflop - 1) << 6) | 0x01; - - wrz_8(BIOS_EQUIP, equip); - - /* Install DPT pointer if this was the only floppy */ - if (getcmditem("dpt") != CMD_NOTFOUND || - ((nflop == 1 || no_bpt) && getcmditem("nodpt") == CMD_NOTFOUND)) { - /* Do install a replacement DPT into INT 1Eh */ - pptr->mdi.dpt_ptr = - hptr->patch_offs + offsetof(struct patch_area, dpt); - } - } - - /* Complete the mBFT */ - mbft->acpi.signature[0] = 'm'; /* "mBFT" */ - mbft->acpi.signature[1] = 'B'; - mbft->acpi.signature[2] = 'F'; - mbft->acpi.signature[3] = 'T'; - mbft->safe_hook = (size_t)&hptr->safe_hook; - mbft->acpi.checksum = -checksum_buf(mbft, mbft->acpi.length); - - /* Install the interrupt handlers */ - printf("old: int13 = %08x int15 = %08x int1e = %08x\n", - rdz_32(BIOS_INT13), rdz_32(BIOS_INT15), rdz_32(BIOS_INT1E)); - - wrz_32(BIOS_INT13, driverptr + hptr->int13_offs); - wrz_32(BIOS_INT15, driverptr + hptr->int15_offs); - if (pptr->mdi.dpt_ptr) - wrz_32(BIOS_INT1E, driverptr + pptr->mdi.dpt_ptr); - - printf("new: int13 = %08x int15 = %08x int1e = %08x\n", - rdz_32(BIOS_INT13), rdz_32(BIOS_INT15), rdz_32(BIOS_INT1E)); - - /* Figure out entry point */ - if (!boot_seg) { - boot_base = 0x7c00; - shdr->sssp = 0x7c00; - shdr->csip = 0x7c00; - } else { - boot_base = boot_seg << 4; - shdr->sssp = boot_seg << 16; - shdr->csip = boot_seg << 16; - } - - /* Relocate the real-mode code to below the stub */ - rm_base = (driveraddr - rm_args.rm_size) & ~15; - if (rm_base < boot_base + boot_len) - die("MEMDISK: bootstrap too large to load\n"); - - relocate_rm_code(rm_base); - - /* Reboot into the new "disk" */ - puts("Loading boot sector... "); - - memcpy((void *)boot_base, - (char *)pptr->mdi.diskbuf + geometry->boot_lba * 512, - boot_len); - - if (getcmditem("pause") != CMD_NOTFOUND) { - puts("press any key to boot... "); - regs.eax.w[0] = 0; - intcall(0x16, ®s, NULL); - } - - puts("booting...\n"); - - /* On return the assembly code will jump to the boot vector */ - shdr->esdi = pnp_install_check(); - shdr->edx = geometry->driveno; -} - |