Move variables from assembler to C code.
[seabios.git] / src / disk.c
index 8901b7d4b2a99a8e016f8f75ba0ad44dd6747c58..13cb1f3f60790069c5734faf34215678750d944c 100644 (file)
 // Copyright (C) 2008  Kevin O'Connor <kevin@koconnor.net>
 // Copyright (C) 2002  MandrakeSoft S.A.
 //
-// This file may be distributed under the terms of the GNU GPLv3 license.
+// This file may be distributed under the terms of the GNU LGPLv3 license.
 
 #include "disk.h" // floppy_13
-#include "biosvar.h" // struct bregs
+#include "biosvar.h" // SET_BDA
+#include "config.h" // CONFIG_*
 #include "util.h" // debug_enter
+#include "pic.h" // eoi_pic2
+#include "bregs.h" // struct bregs
+#include "pci.h" // pci_bdf_to_bus
+#include "atabits.h" // ATA_CB_STAT
 
+
+/****************************************************************
+ * Helper functions
+ ****************************************************************/
+
+void
+__disk_ret(struct bregs *regs, u32 linecode, const char *fname)
+{
+    u8 code = linecode;
+    SET_BDA(disk_last_status, code);
+    if (code)
+        __set_code_fail(regs, linecode, fname);
+    else
+        set_code_success(regs);
+}
+
+static void
+__disk_stub(struct bregs *regs, int lineno, const char *fname)
+{
+    __debug_stub(regs, lineno, fname);
+    __disk_ret(regs, DISK_RET_SUCCESS | (lineno << 8), fname);
+}
+
+#define DISK_STUB(regs)                         \
+    __disk_stub((regs), __LINE__, __func__)
+
+static int
+__send_disk_op(struct disk_op_s *op_p, u16 op_s)
+{
+    struct disk_op_s dop;
+    memcpy_far(MAKE_FARPTR(GET_SEG(SS), &dop)
+               , MAKE_FARPTR(op_s, op_p)
+               , sizeof(dop));
+
+    dprintf(DEBUG_HDL_13, "disk_op d=%d lba=%d buf=%p count=%d cmd=%d\n"
+            , dop.driveid, (u32)dop.lba, dop.far_buffer
+            , dop.count, dop.command);
+
+    irq_enable();
+
+    int status;
+    if (dop.command == CMD_CDEMU_READ)
+        status = cdrom_read_512(&dop);
+    else if (dop.command == CMD_CDROM_READ)
+        status = cdrom_read(&dop);
+    else
+        status = ata_cmd_data(&dop);
+
+    irq_disable();
+
+    return status;
+}
+
+static int
+send_disk_op(struct disk_op_s *op)
+{
+    return stack_hop((u32)op, GET_SEG(SS), 0, __send_disk_op);
+}
+
+static void
+basic_access(struct bregs *regs, u8 device, u16 command)
+{
+    struct disk_op_s dop;
+    dop.lba = 0;
+    dop.driveid = device;
+    u8 type = GET_GLOBAL(ATA.devices[device].type);
+    u16 nlc, nlh, nlspt;
+    if (type == ATA_TYPE_ATA) {
+        nlc   = GET_GLOBAL(ATA.devices[device].lchs.cylinders);
+        nlh   = GET_GLOBAL(ATA.devices[device].lchs.heads);
+        nlspt = GET_GLOBAL(ATA.devices[device].lchs.spt);
+        dop.command = command;
+    } else {
+        // Must be cd emulation.
+        u16 ebda_seg = get_ebda_seg();
+        nlc   = GET_EBDA2(ebda_seg, cdemu.cylinders);
+        nlh   = GET_EBDA2(ebda_seg, cdemu.heads);
+        nlspt = GET_EBDA2(ebda_seg, cdemu.spt);
+        dop.lba = GET_EBDA2(ebda_seg, cdemu.ilba) * 4;
+        dop.command = CMD_CDEMU_READ;
+    }
+
+    dop.count       = regs->al;
+    u16 cylinder    = regs->ch | ((((u16) regs->cl) << 2) & 0x300);
+    u16 sector      = regs->cl & 0x3f;
+    u16 head        = regs->dh;
+
+    if (dop.count > 128 || dop.count == 0 || sector == 0) {
+        dprintf(1, "int13_harddisk: function %02x, parameter out of range!\n"
+                , regs->ah);
+        disk_ret(regs, DISK_RET_EPARAM);
+        return;
+    }
+
+    // sanity check on cyl heads, sec
+    if (cylinder >= nlc || head >= nlh || sector > nlspt) {
+        dprintf(1, "int13_harddisk: function %02x, parameters out of"
+                " range %04x/%04x/%04x!\n"
+                , regs->ah, cylinder, head, sector);
+        disk_ret(regs, DISK_RET_EPARAM);
+        return;
+    }
+
+    if (!command) {
+        // If verify or seek
+        disk_ret(regs, DISK_RET_SUCCESS);
+        return;
+    }
+
+    // translate lchs to lba
+    dop.lba += (((((u32)cylinder * (u32)nlh) + (u32)head) * (u32)nlspt)
+                + (u32)sector - 1);
+
+    u16 segment = regs->es;
+    u16 offset  = regs->bx;
+    dop.far_buffer = MAKE_FARPTR(segment, offset);
+
+    int status = send_disk_op(&dop);
+
+    // Set nb of sector transferred
+    regs->al = GET_EBDA(sector_count);
+
+    if (status != 0) {
+        dprintf(1, "int13_harddisk: function %02x, error %d!\n"
+                , regs->ah, status);
+        disk_ret(regs, DISK_RET_EBADTRACK);
+        return;
+    }
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+static void
+extended_access(struct bregs *regs, u8 device, u16 command)
+{
+    struct disk_op_s dop;
+    // Get lba and check.
+    dop.lba = GET_INT13EXT(regs, lba);
+    dop.command = command;
+    dop.driveid = device;
+    u8 type = GET_GLOBAL(ATA.devices[device].type);
+    if (type == ATA_TYPE_ATA) {
+        if (dop.lba >= GET_GLOBAL(ATA.devices[device].sectors)) {
+            dprintf(1, "int13_harddisk: function %02x. LBA out of range\n"
+                    , regs->ah);
+            disk_ret(regs, DISK_RET_EPARAM);
+            return;
+        }
+    } else {
+        dop.command = CMD_CDROM_READ;
+    }
+
+    if (!command) {
+        // If verify or seek
+        disk_ret(regs, DISK_RET_SUCCESS);
+        return;
+    }
+
+    u16 segment = GET_INT13EXT(regs, segment);
+    u16 offset = GET_INT13EXT(regs, offset);
+    dop.far_buffer = MAKE_FARPTR(segment, offset);
+    dop.count = GET_INT13EXT(regs, count);
+
+    int status = send_disk_op(&dop);
+
+    SET_INT13EXT(regs, count, GET_EBDA(sector_count));
+
+    if (status != 0) {
+        dprintf(1, "int13_harddisk: function %02x, error %d!\n"
+                , regs->ah, status);
+        disk_ret(regs, DISK_RET_EBADTRACK);
+        return;
+    }
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+
+/****************************************************************
+ * Hard Drive functions
+ ****************************************************************/
+
+// disk controller reset
 static void
-disk_13(struct bregs *regs, u8 drive)
+disk_1300(struct bregs *regs, u8 device)
 {
-    set_cf(regs, 1);
+    ata_reset(device);
+}
+
+// read disk status
+static void
+disk_1301(struct bregs *regs, u8 device)
+{
+    u8 v = GET_BDA(disk_last_status);
+    regs->ah = v;
+    set_cf(regs, v);
+    // XXX - clear disk_last_status?
+}
+
+// read disk sectors
+static void
+disk_1302(struct bregs *regs, u8 device)
+{
+    basic_access(regs, device, ATA_CMD_READ_SECTORS);
+}
+
+// write disk sectors
+static void
+disk_1303(struct bregs *regs, u8 device)
+{
+    basic_access(regs, device, ATA_CMD_WRITE_SECTORS);
+}
+
+// verify disk sectors
+static void
+disk_1304(struct bregs *regs, u8 device)
+{
+    basic_access(regs, device, 0);
+    // FIXME verify
+}
+
+// format disk track
+static void
+disk_1305(struct bregs *regs, u8 device)
+{
+    DISK_STUB(regs);
+}
+
+// read disk drive parameters
+static void
+disk_1308(struct bregs *regs, u8 device)
+{
+    // Get logical geometry from table
+    u16 nlc = GET_GLOBAL(ATA.devices[device].lchs.cylinders);
+    u16 nlh = GET_GLOBAL(ATA.devices[device].lchs.heads);
+    u16 nlspt = GET_GLOBAL(ATA.devices[device].lchs.spt);
+    u16 count = GET_BDA(hdcount);
+
+    nlc = nlc - 2; /* 0 based , last sector not used */
+    regs->al = 0;
+    regs->ch = nlc & 0xff;
+    regs->cl = ((nlc >> 2) & 0xc0) | (nlspt & 0x3f);
+    regs->dh = nlh - 1;
+    regs->dl = count; /* FIXME returns 0, 1, or n hard drives */
+
+    // FIXME should set ES & DI
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+// initialize drive parameters
+static void
+disk_1309(struct bregs *regs, u8 device)
+{
+    DISK_STUB(regs);
+}
+
+// seek to specified cylinder
+static void
+disk_130c(struct bregs *regs, u8 device)
+{
+    DISK_STUB(regs);
+}
+
+// alternate disk reset
+static void
+disk_130d(struct bregs *regs, u8 device)
+{
+    DISK_STUB(regs);
+}
+
+// check drive ready
+static void
+disk_1310(struct bregs *regs, u8 device)
+{
+    // should look at 40:8E also???
+
+    // Read the status from controller
+    u8 status = inb(GET_GLOBAL(ATA.channels[device/2].iobase1) + ATA_CB_STAT);
+    if ( (status & ( ATA_CB_STAT_BSY | ATA_CB_STAT_RDY )) == ATA_CB_STAT_RDY )
+        disk_ret(regs, DISK_RET_SUCCESS);
+    else
+        disk_ret(regs, DISK_RET_ENOTREADY);
+}
+
+// recalibrate
+static void
+disk_1311(struct bregs *regs, u8 device)
+{
+    DISK_STUB(regs);
+}
+
+// controller internal diagnostic
+static void
+disk_1314(struct bregs *regs, u8 device)
+{
+    DISK_STUB(regs);
+}
+
+// read disk drive size
+static void
+disk_1315(struct bregs *regs, u8 device)
+{
+    // Get logical geometry from table
+    u16 nlc   = GET_GLOBAL(ATA.devices[device].lchs.cylinders);
+    u16 nlh   = GET_GLOBAL(ATA.devices[device].lchs.heads);
+    u16 nlspt = GET_GLOBAL(ATA.devices[device].lchs.spt);
+
+    // Compute sector count seen by int13
+    u32 lba = (u32)(nlc - 1) * (u32)nlh * (u32)nlspt;
+    regs->cx = lba >> 16;
+    regs->dx = lba & 0xffff;
+
+    disk_ret(regs, DISK_RET_SUCCESS);
+    regs->ah = 3; // hard disk accessible
+}
+
+// IBM/MS installation check
+static void
+disk_1341(struct bregs *regs, u8 device)
+{
+    regs->bx = 0xaa55;  // install check
+    regs->cx = 0x0007;  // ext disk access and edd, removable supported
+    disk_ret(regs, DISK_RET_SUCCESS);
+    regs->ah = 0x30;    // EDD 3.0
+}
+
+// IBM/MS extended read
+static void
+disk_1342(struct bregs *regs, u8 device)
+{
+    extended_access(regs, device, ATA_CMD_READ_SECTORS);
+}
+
+// IBM/MS extended write
+static void
+disk_1343(struct bregs *regs, u8 device)
+{
+    extended_access(regs, device, ATA_CMD_WRITE_SECTORS);
+}
+
+// IBM/MS verify
+static void
+disk_1344(struct bregs *regs, u8 device)
+{
+    extended_access(regs, device, 0);
+}
+
+// IBM/MS lock/unlock drive
+static void
+disk_1345(struct bregs *regs, u8 device)
+{
+    // Always success for HD
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+// IBM/MS eject media
+static void
+disk_1346(struct bregs *regs, u8 device)
+{
+    // Volume Not Removable
+    disk_ret(regs, DISK_RET_ENOTREMOVABLE);
+}
+
+// IBM/MS extended seek
+static void
+disk_1347(struct bregs *regs, u8 device)
+{
+    extended_access(regs, device, 0);
+}
+
+// IBM/MS get drive parameters
+static void
+disk_1348(struct bregs *regs, u8 device)
+{
+    u16 size = GET_INT13DPT(regs, size);
+
+    // Buffer is too small
+    if (size < 26) {
+        disk_ret(regs, DISK_RET_EPARAM);
+        return;
+    }
+
+    // EDD 1.x
+
+    u8  type    = GET_GLOBAL(ATA.devices[device].type);
+    u16 npc     = GET_GLOBAL(ATA.devices[device].pchs.cylinders);
+    u16 nph     = GET_GLOBAL(ATA.devices[device].pchs.heads);
+    u16 npspt   = GET_GLOBAL(ATA.devices[device].pchs.spt);
+    u64 lba     = GET_GLOBAL(ATA.devices[device].sectors);
+    u16 blksize = GET_GLOBAL(ATA.devices[device].blksize);
+
+    dprintf(DEBUG_HDL_13, "disk_1348 size=%d t=%d chs=%d,%d,%d lba=%d bs=%d\n"
+            , size, type, npc, nph, npspt, (u32)lba, blksize);
+
+    SET_INT13DPT(regs, size, 26);
+    if (type == ATA_TYPE_ATA) {
+        if (lba > (u64)npspt*nph*0x3fff) {
+            SET_INT13DPT(regs, infos, 0x00); // geometry is invalid
+            SET_INT13DPT(regs, cylinders, 0x3fff);
+        } else {
+            SET_INT13DPT(regs, infos, 0x02); // geometry is valid
+            SET_INT13DPT(regs, cylinders, (u32)npc);
+        }
+        SET_INT13DPT(regs, heads, (u32)nph);
+        SET_INT13DPT(regs, spt, (u32)npspt);
+        SET_INT13DPT(regs, sector_count, lba);
+    } else {
+        // ATAPI
+        // 0x74 = removable, media change, lockable, max values
+        SET_INT13DPT(regs, infos, 0x74);
+        SET_INT13DPT(regs, cylinders, 0xffffffff);
+        SET_INT13DPT(regs, heads, 0xffffffff);
+        SET_INT13DPT(regs, spt, 0xffffffff);
+        SET_INT13DPT(regs, sector_count, (u64)-1);
+    }
+    SET_INT13DPT(regs, blksize, blksize);
+
+    if (size < 30) {
+        disk_ret(regs, DISK_RET_SUCCESS);
+        return;
+    }
+
+    // EDD 2.x
+
+    u16 ebda_seg = get_ebda_seg();
+    SET_INT13DPT(regs, size, 30);
+
+    SET_INT13DPT(regs, dpte_segment, ebda_seg);
+    SET_INT13DPT(regs, dpte_offset
+                 , offsetof(struct extended_bios_data_area_s, dpte));
+
+    // Fill in dpte
+    u8 channel = device / 2;
+    u8 slave = device % 2;
+    u16 iobase1 = GET_GLOBAL(ATA.channels[channel].iobase1);
+    u16 iobase2 = GET_GLOBAL(ATA.channels[channel].iobase2);
+    u8 irq = GET_GLOBAL(ATA.channels[channel].irq);
+    u8 mode = GET_GLOBAL(ATA.devices[device].mode);
+
+    u16 options = 0;
+    if (type == ATA_TYPE_ATA) {
+        u8 translation = GET_GLOBAL(ATA.devices[device].translation);
+        if (translation != ATA_TRANSLATION_NONE) {
+            options |= 1<<3; // CHS translation
+            if (translation == ATA_TRANSLATION_LBA)
+                options |= 1<<9;
+            if (translation == ATA_TRANSLATION_RECHS)
+                options |= 3<<9;
+        }
+    } else {
+        // ATAPI
+        options |= 1<<5; // removable device
+        options |= 1<<6; // atapi device
+    }
+    options |= 1<<4; // lba translation
+    if (mode == ATA_MODE_PIO32)
+        options |= 1<<7;
+
+    SET_EBDA2(ebda_seg, dpte.iobase1, iobase1);
+    SET_EBDA2(ebda_seg, dpte.iobase2, iobase2 + ATA_CB_DC);
+    SET_EBDA2(ebda_seg, dpte.prefix, ((slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0)
+                                      | ATA_CB_DH_LBA));
+    SET_EBDA2(ebda_seg, dpte.unused, 0xcb);
+    SET_EBDA2(ebda_seg, dpte.irq, irq);
+    SET_EBDA2(ebda_seg, dpte.blkcount, 1);
+    SET_EBDA2(ebda_seg, dpte.dma, 0);
+    SET_EBDA2(ebda_seg, dpte.pio, 0);
+    SET_EBDA2(ebda_seg, dpte.options, options);
+    SET_EBDA2(ebda_seg, dpte.reserved, 0);
+    SET_EBDA2(ebda_seg, dpte.revision, 0x11);
+
+    u8 *p = MAKE_FARPTR(ebda_seg
+                        , offsetof(struct extended_bios_data_area_s, dpte));
+    SET_EBDA2(ebda_seg, dpte.checksum, -checksum(p, 15));
+
+    if (size < 66) {
+        disk_ret(regs, DISK_RET_SUCCESS);
+        return;
+    }
+
+    // EDD 3.x
+    SET_INT13DPT(regs, key, 0xbedd);
+    SET_INT13DPT(regs, dpi_length, 36);
+    SET_INT13DPT(regs, reserved1, 0);
+    SET_INT13DPT(regs, reserved2, 0);
+
+    SET_INT13DPT(regs, host_bus[0], 'P');
+    SET_INT13DPT(regs, host_bus[1], 'C');
+    SET_INT13DPT(regs, host_bus[2], 'I');
+    SET_INT13DPT(regs, host_bus[3], 0);
+
+    u32 bdf = GET_GLOBAL(ATA.channels[channel].pci_bdf);
+    u32 path = (pci_bdf_to_bus(bdf) | (pci_bdf_to_dev(bdf) << 8)
+                | (pci_bdf_to_fn(bdf) << 16));
+    SET_INT13DPT(regs, iface_path, path);
+
+    SET_INT13DPT(regs, iface_type[0], 'A');
+    SET_INT13DPT(regs, iface_type[1], 'T');
+    SET_INT13DPT(regs, iface_type[2], 'A');
+    SET_INT13DPT(regs, iface_type[3], 0);
+    SET_INT13DPT(regs, iface_type[4], 0);
+    SET_INT13DPT(regs, iface_type[5], 0);
+    SET_INT13DPT(regs, iface_type[6], 0);
+    SET_INT13DPT(regs, iface_type[7], 0);
+
+    SET_INT13DPT(regs, device_path, slave);
+
+    SET_INT13DPT(regs, checksum, -checksum(MAKE_FARPTR(regs->ds, 30), 35));
+
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+// IBM/MS extended media change
+static void
+disk_1349(struct bregs *regs, u8 device)
+{
+    // Always success for HD
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+static void
+disk_134e01(struct bregs *regs, u8 device)
+{
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+static void
+disk_134e03(struct bregs *regs, u8 device)
+{
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+static void
+disk_134e04(struct bregs *regs, u8 device)
+{
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+static void
+disk_134e06(struct bregs *regs, u8 device)
+{
+    disk_ret(regs, DISK_RET_SUCCESS);
+}
+
+static void
+disk_134eXX(struct bregs *regs, u8 device)
+{
+    disk_ret(regs, DISK_RET_EPARAM);
+}
+
+// IBM/MS set hardware configuration
+static void
+disk_134e(struct bregs *regs, u8 device)
+{
+    switch (regs->al) {
+    case 0x01: disk_134e01(regs, device); break;
+    case 0x03: disk_134e03(regs, device); break;
+    case 0x04: disk_134e04(regs, device); break;
+    case 0x06: disk_134e06(regs, device); break;
+    default:   disk_134eXX(regs, device); break;
+    }
+}
+
+void
+disk_13XX(struct bregs *regs, u8 device)
+{
+    disk_ret(regs, DISK_RET_EPARAM);
+}
+
+void
+disk_13(struct bregs *regs, u8 device)
+{
+    //debug_stub(regs);
+
+    // clear completion flag
+    SET_BDA(disk_interrupt_flag, 0);
+
+    switch (regs->ah) {
+    case 0x00: disk_1300(regs, device); break;
+    case 0x01: disk_1301(regs, device); break;
+    case 0x02: disk_1302(regs, device); break;
+    case 0x03: disk_1303(regs, device); break;
+    case 0x04: disk_1304(regs, device); break;
+    case 0x05: disk_1305(regs, device); break;
+    case 0x08: disk_1308(regs, device); break;
+    case 0x09: disk_1309(regs, device); break;
+    case 0x0c: disk_130c(regs, device); break;
+    case 0x0d: disk_130d(regs, device); break;
+    case 0x10: disk_1310(regs, device); break;
+    case 0x11: disk_1311(regs, device); break;
+    case 0x14: disk_1314(regs, device); break;
+    case 0x15: disk_1315(regs, device); break;
+    case 0x41: disk_1341(regs, device); break;
+    case 0x42: disk_1342(regs, device); break;
+    case 0x43: disk_1343(regs, device); break;
+    case 0x44: disk_1344(regs, device); break;
+    case 0x45: disk_1345(regs, device); break;
+    case 0x46: disk_1346(regs, device); break;
+    case 0x47: disk_1347(regs, device); break;
+    case 0x48: disk_1348(regs, device); break;
+    case 0x49: disk_1349(regs, device); break;
+    case 0x4e: disk_134e(regs, device); break;
+    default:   disk_13XX(regs, device); break;
+    }
+}
+
+
+/****************************************************************
+ * Entry points
+ ****************************************************************/
+
+static u8
+get_device(struct bregs *regs, u8 iscd, u8 drive)
+{
+    // basic check : device has to be defined
+    if (drive >= CONFIG_MAX_ATA_DEVICES) {
+        disk_ret(regs, DISK_RET_EPARAM);
+        return CONFIG_MAX_ATA_DEVICES;
+    }
+
+    // Get the ata channel
+    u8 device = GET_GLOBAL(ATA.idmap[iscd][drive]);
+
+    // basic check : device has to be valid
+    if (device >= CONFIG_MAX_ATA_DEVICES) {
+        disk_ret(regs, DISK_RET_EPARAM);
+        return CONFIG_MAX_ATA_DEVICES;
+    }
+
+    return device;
 }
 
 static void
@@ -22,46 +651,67 @@ handle_legacy_disk(struct bregs *regs, u8 drive)
         floppy_13(regs, drive);
         return;
     }
-#if BX_USE_ATADRV
-    if (drive >= 0xE0) {
-        int13_cdrom(regs); // xxx
+
+    if (! CONFIG_ATA) {
+        // XXX - old code had other disk access method.
+        disk_ret(regs, DISK_RET_EPARAM);
+        return;
+    }
+
+    if (drive >= 0xe0) {
+        u8 device = get_device(regs, 1, drive - 0xe0);
+        if (device >= CONFIG_MAX_ATA_DEVICES)
+            return;
+        cdrom_13(regs, device);
         return;
     }
-#endif
 
-    disk_13(regs, drive);
+    u8 device = get_device(regs, 0, drive - 0x80);
+    if (device >= CONFIG_MAX_ATA_DEVICES)
+        return;
+    disk_13(regs, device);
 }
 
-void VISIBLE
+void VISIBLE16
 handle_40(struct bregs *regs)
 {
-    debug_enter(regs);
+    debug_enter(regs, DEBUG_HDL_40);
     handle_legacy_disk(regs, regs->dl);
-    debug_exit(regs);
 }
 
 // INT 13h Fixed Disk Services Entry Point
-void VISIBLE
+void VISIBLE16
 handle_13(struct bregs *regs)
 {
-    debug_enter(regs);
+    debug_enter(regs, DEBUG_HDL_13);
     u8 drive = regs->dl;
-#if BX_ELTORITO_BOOT
-    if (regs->ah >= 0x4a || regs->ah <= 0x4d) {
-        int13_eltorito(regs);
-    } else if (cdemu_isactive() && cdrom_emulated_drive()) {
-        int13_cdemu(regs);
-    } else
-#endif
-        handle_legacy_disk(regs, drive);
-    debug_exit(regs);
+
+    if (CONFIG_CDROM_EMU) {
+        if (regs->ah == 0x4b) {
+            cdemu_134b(regs);
+            return;
+        }
+        u16 ebda_seg = get_ebda_seg();
+        if (GET_EBDA2(ebda_seg, cdemu.active)) {
+            if (drive == GET_EBDA2(ebda_seg, cdemu.emulated_drive)) {
+                cdemu_13(regs);
+                return;
+            }
+            if (drive < 0xe0)
+                drive--;
+        }
+    }
+    handle_legacy_disk(regs, drive);
 }
 
 // record completion in BIOS task complete flag
-void VISIBLE
-handle_76(struct bregs *regs)
+void VISIBLE16
+handle_76()
 {
-    debug_enter(regs);
-    SET_BDA(floppy_harddisk_info, 0xff);
-    eoi_both_pics();
+    debug_isr(DEBUG_ISR_76);
+    SET_BDA(disk_interrupt_flag, 0xff);
+    eoi_pic2();
 }
+
+// Old Fixed Disk Parameter Table (newer tables are in the ebda).
+struct fdpt_s OldFDPT VAR16FIXED(0xe401);