Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 1 | // 16bit code to access hard drives. |
| 2 | // |
| 3 | // Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net> |
| 4 | // Copyright (C) 2002 MandrakeSoft S.A. |
| 5 | // |
Kevin O'Connor | b1b7c2a | 2009-01-15 20:52:58 -0500 | [diff] [blame] | 6 | // This file may be distributed under the terms of the GNU LGPLv3 license. |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 7 | |
| 8 | #include "disk.h" // floppy_13 |
Kevin O'Connor | 9521e26 | 2008-07-04 13:04:29 -0400 | [diff] [blame] | 9 | #include "biosvar.h" // SET_BDA |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 10 | #include "config.h" // CONFIG_* |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 11 | #include "util.h" // debug_enter |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 12 | #include "pic.h" // eoi_pic2 |
Kevin O'Connor | 9521e26 | 2008-07-04 13:04:29 -0400 | [diff] [blame] | 13 | #include "bregs.h" // struct bregs |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 14 | #include "pci.h" // pci_bdf_to_bus |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 15 | #include "ata.h" // ATA_CB_DC |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 16 | |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 17 | |
| 18 | /**************************************************************** |
| 19 | * Helper functions |
| 20 | ****************************************************************/ |
| 21 | |
Kevin O'Connor | 567e4e3 | 2008-04-05 11:37:51 -0400 | [diff] [blame] | 22 | void |
Kevin O'Connor | 0560034 | 2009-01-02 13:10:58 -0500 | [diff] [blame] | 23 | __disk_ret(struct bregs *regs, u32 linecode, const char *fname) |
Kevin O'Connor | 567e4e3 | 2008-04-05 11:37:51 -0400 | [diff] [blame] | 24 | { |
Kevin O'Connor | 0560034 | 2009-01-02 13:10:58 -0500 | [diff] [blame] | 25 | u8 code = linecode; |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 26 | if (regs->dl < 0x80) |
| 27 | SET_BDA(floppy_last_status, code); |
| 28 | else |
| 29 | SET_BDA(disk_last_status, code); |
Kevin O'Connor | 567e4e3 | 2008-04-05 11:37:51 -0400 | [diff] [blame] | 30 | if (code) |
Kevin O'Connor | 0560034 | 2009-01-02 13:10:58 -0500 | [diff] [blame] | 31 | __set_code_fail(regs, linecode, fname); |
Kevin O'Connor | 567e4e3 | 2008-04-05 11:37:51 -0400 | [diff] [blame] | 32 | else |
| 33 | set_code_success(regs); |
| 34 | } |
| 35 | |
| 36 | static void |
Kevin O'Connor | 0560034 | 2009-01-02 13:10:58 -0500 | [diff] [blame] | 37 | __disk_stub(struct bregs *regs, int lineno, const char *fname) |
Kevin O'Connor | 567e4e3 | 2008-04-05 11:37:51 -0400 | [diff] [blame] | 38 | { |
Kevin O'Connor | 0560034 | 2009-01-02 13:10:58 -0500 | [diff] [blame] | 39 | __debug_stub(regs, lineno, fname); |
| 40 | __disk_ret(regs, DISK_RET_SUCCESS | (lineno << 8), fname); |
Kevin O'Connor | 567e4e3 | 2008-04-05 11:37:51 -0400 | [diff] [blame] | 41 | } |
| 42 | |
Kevin O'Connor | 0560034 | 2009-01-02 13:10:58 -0500 | [diff] [blame] | 43 | #define DISK_STUB(regs) \ |
| 44 | __disk_stub((regs), __LINE__, __func__) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 45 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 46 | // Execute a "disk_op_s" request - this runs on a stack in the ebda. |
Kevin O'Connor | 7f34309 | 2009-01-01 18:31:11 -0500 | [diff] [blame] | 47 | static int |
Kevin O'Connor | 8b267cb | 2009-01-19 19:25:21 -0500 | [diff] [blame] | 48 | __send_disk_op(struct disk_op_s *op_far, u16 op_seg) |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 49 | { |
Kevin O'Connor | 7f34309 | 2009-01-01 18:31:11 -0500 | [diff] [blame] | 50 | struct disk_op_s dop; |
Kevin O'Connor | 8b267cb | 2009-01-19 19:25:21 -0500 | [diff] [blame] | 51 | memcpy_far(GET_SEG(SS), &dop |
| 52 | , op_seg, op_far |
| 53 | , sizeof(dop)); |
Kevin O'Connor | 7f34309 | 2009-01-01 18:31:11 -0500 | [diff] [blame] | 54 | |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 55 | dprintf(DEBUG_HDL_13, "disk_op d=%d lba=%d buf=%p count=%d cmd=%d\n" |
Kevin O'Connor | 35ae726 | 2009-01-19 15:44:44 -0500 | [diff] [blame] | 56 | , dop.driveid, (u32)dop.lba, dop.buf_fl |
Kevin O'Connor | 7f34309 | 2009-01-01 18:31:11 -0500 | [diff] [blame] | 57 | , dop.count, dop.command); |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 58 | |
| 59 | irq_enable(); |
| 60 | |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 61 | int status = 0; |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 62 | u8 type = GET_GLOBAL(Drives.drives[dop.driveid].type); |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 63 | if (type == DTYPE_ATA) |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 64 | status = process_ata_op(&dop); |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 65 | else if (type == DTYPE_ATAPI) |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 66 | status = process_atapi_op(&dop); |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 67 | |
| 68 | irq_disable(); |
| 69 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 70 | // Update count with total sectors transferred. |
Kevin O'Connor | 9ae1e9b | 2009-08-09 18:06:40 -0400 | [diff] [blame] | 71 | SET_FARVAR(op_seg, op_far->count, dop.count); |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 72 | |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 73 | return status; |
| 74 | } |
| 75 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 76 | // Execute a "disk_op_s" request by jumping to a stack in the ebda. |
Kevin O'Connor | 7f34309 | 2009-01-01 18:31:11 -0500 | [diff] [blame] | 77 | static int |
| 78 | send_disk_op(struct disk_op_s *op) |
| 79 | { |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 80 | if (! CONFIG_DRIVES) |
Kevin O'Connor | 0d9e673 | 2009-01-17 21:54:16 -0500 | [diff] [blame] | 81 | return -1; |
| 82 | |
Kevin O'Connor | 7f34309 | 2009-01-01 18:31:11 -0500 | [diff] [blame] | 83 | return stack_hop((u32)op, GET_SEG(SS), 0, __send_disk_op); |
| 84 | } |
| 85 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 86 | // Obtain the requested disk lba from an old-style chs request. |
| 87 | static int |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 88 | legacy_lba(struct bregs *regs, u16 lchs_seg, struct chs_s *lchs_far) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 89 | { |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 90 | u8 count = regs->al; |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 91 | u16 cylinder = regs->ch | ((((u16)regs->cl) << 2) & 0x300); |
| 92 | u16 sector = regs->cl & 0x3f; |
| 93 | u16 head = regs->dh; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 94 | |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 95 | if (count > 128 || count == 0 || sector == 0) { |
Kevin O'Connor | ac8df8c | 2008-05-24 23:46:33 -0400 | [diff] [blame] | 96 | dprintf(1, "int13_harddisk: function %02x, parameter out of range!\n" |
Kevin O'Connor | 0cdac0e | 2008-03-29 12:45:53 -0400 | [diff] [blame] | 97 | , regs->ah); |
| 98 | disk_ret(regs, DISK_RET_EPARAM); |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 99 | return -1; |
Kevin O'Connor | 0cdac0e | 2008-03-29 12:45:53 -0400 | [diff] [blame] | 100 | } |
| 101 | |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 102 | u16 nlc = GET_FARVAR(lchs_seg, lchs_far->cylinders); |
| 103 | u16 nlh = GET_FARVAR(lchs_seg, lchs_far->heads); |
| 104 | u16 nlspt = GET_FARVAR(lchs_seg, lchs_far->spt); |
| 105 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 106 | // sanity check on cyl heads, sec |
Kevin O'Connor | 1fcf144 | 2008-03-11 19:42:41 -0400 | [diff] [blame] | 107 | if (cylinder >= nlc || head >= nlh || sector > nlspt) { |
Kevin O'Connor | ac8df8c | 2008-05-24 23:46:33 -0400 | [diff] [blame] | 108 | dprintf(1, "int13_harddisk: function %02x, parameters out of" |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 109 | " range %04x/%04x/%04x!\n" |
| 110 | , regs->ah, cylinder, head, sector); |
| 111 | disk_ret(regs, DISK_RET_EPARAM); |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 112 | return -1; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 113 | } |
| 114 | |
Kevin O'Connor | 049d5a2 | 2008-03-13 19:09:49 -0400 | [diff] [blame] | 115 | // translate lchs to lba |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 116 | return (((((u32)cylinder * (u32)nlh) + (u32)head) * (u32)nlspt) |
| 117 | + (u32)sector - 1); |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 118 | } |
| 119 | |
| 120 | // Perform read/write/verify using old-style chs accesses |
| 121 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 122 | basic_access(struct bregs *regs, u8 driveid, u16 command) |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 123 | { |
| 124 | struct disk_op_s dop; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 125 | dop.driveid = driveid; |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 126 | dop.command = command; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 127 | int lba = legacy_lba(regs, get_global_seg(), &Drives.drives[driveid].lchs); |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 128 | if (lba < 0) |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 129 | return; |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 130 | dop.lba = lba; |
| 131 | dop.count = regs->al; |
| 132 | dop.buf_fl = MAKE_FLATPTR(regs->es, regs->bx); |
Kevin O'Connor | aa2590c | 2008-03-22 23:13:24 -0400 | [diff] [blame] | 133 | |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 134 | int status = send_disk_op(&dop); |
Kevin O'Connor | 74799df | 2008-03-12 20:49:07 -0400 | [diff] [blame] | 135 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 136 | regs->al = dop.count; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 137 | |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 138 | disk_ret(regs, status); |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 139 | } |
| 140 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 141 | // Perform cdemu read/verify |
| 142 | void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 143 | cdemu_access(struct bregs *regs, u8 driveid, u16 command) |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 144 | { |
| 145 | struct disk_op_s dop; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 146 | dop.driveid = driveid; |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 147 | dop.command = command; |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 148 | u16 ebda_seg = get_ebda_seg(); |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 149 | int vlba = legacy_lba( |
| 150 | regs, ebda_seg |
| 151 | , (void*)offsetof(struct extended_bios_data_area_s, cdemu.lchs)); |
| 152 | if (vlba < 0) |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 153 | return; |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 154 | dop.lba = GET_EBDA2(ebda_seg, cdemu.ilba) + vlba / 4; |
| 155 | u8 count = regs->al; |
| 156 | u8 *cdbuf_far = (void*)offsetof(struct extended_bios_data_area_s, cdemu_buf); |
| 157 | u8 *dest_far = (void*)(regs->bx+0); |
| 158 | regs->al = 0; |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 159 | int status = DISK_RET_SUCCESS; |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 160 | |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 161 | if (vlba & 3) { |
| 162 | dop.count = 1; |
| 163 | dop.buf_fl = MAKE_FLATPTR(ebda_seg, cdbuf_far); |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 164 | status = send_disk_op(&dop); |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 165 | if (status) |
| 166 | goto fail; |
| 167 | u8 thiscount = 4 - (vlba & 3); |
| 168 | if (thiscount > count) |
| 169 | thiscount = count; |
| 170 | count -= thiscount; |
| 171 | memcpy_far(regs->es, dest_far |
| 172 | , ebda_seg, cdbuf_far + (vlba & 3) * 512 |
| 173 | , thiscount * 512); |
| 174 | dest_far += thiscount * 512; |
| 175 | regs->al += thiscount; |
| 176 | dop.lba++; |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 177 | } |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 178 | |
| 179 | if (count > 3) { |
| 180 | dop.count = count / 4; |
| 181 | dop.buf_fl = MAKE_FLATPTR(regs->es, dest_far); |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 182 | status = send_disk_op(&dop); |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 183 | regs->al += dop.count * 4; |
| 184 | if (status) |
| 185 | goto fail; |
| 186 | u8 thiscount = count & ~3; |
| 187 | count &= 3; |
| 188 | dest_far += thiscount * 512; |
| 189 | dop.lba += thiscount / 4; |
| 190 | } |
| 191 | |
| 192 | if (count) { |
| 193 | dop.count = 1; |
| 194 | dop.buf_fl = MAKE_FLATPTR(ebda_seg, cdbuf_far); |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 195 | status = send_disk_op(&dop); |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 196 | if (status) |
| 197 | goto fail; |
| 198 | u8 thiscount = count; |
| 199 | memcpy_far(regs->es, dest_far, ebda_seg, cdbuf_far, thiscount * 512); |
| 200 | regs->al += thiscount; |
| 201 | } |
| 202 | |
Kevin O'Connor | b68ac71 | 2009-08-09 17:25:19 -0400 | [diff] [blame] | 203 | fail: |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 204 | disk_ret(regs, status); |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 205 | } |
| 206 | |
| 207 | // Perform read/write/verify using new-style "int13ext" accesses. |
Kevin O'Connor | ed12849 | 2008-03-11 11:14:59 -0400 | [diff] [blame] | 208 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 209 | extended_access(struct bregs *regs, u8 driveid, u16 command) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 210 | { |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 211 | struct disk_op_s dop; |
Kevin O'Connor | 1bb3b5c | 2008-05-14 00:43:13 -0400 | [diff] [blame] | 212 | // Get lba and check. |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 213 | dop.lba = GET_INT13EXT(regs, lba); |
| 214 | dop.command = command; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 215 | dop.driveid = driveid; |
| 216 | if (dop.lba >= GET_GLOBAL(Drives.drives[driveid].sectors)) { |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 217 | dprintf(1, "int13_harddisk: function %02x. LBA out of range\n" |
| 218 | , regs->ah); |
| 219 | disk_ret(regs, DISK_RET_EPARAM); |
| 220 | return; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 221 | } |
| 222 | |
Kevin O'Connor | aa2590c | 2008-03-22 23:13:24 -0400 | [diff] [blame] | 223 | u16 segment = GET_INT13EXT(regs, segment); |
| 224 | u16 offset = GET_INT13EXT(regs, offset); |
Kevin O'Connor | 35ae726 | 2009-01-19 15:44:44 -0500 | [diff] [blame] | 225 | dop.buf_fl = MAKE_FLATPTR(segment, offset); |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 226 | dop.count = GET_INT13EXT(regs, count); |
Kevin O'Connor | aa2590c | 2008-03-22 23:13:24 -0400 | [diff] [blame] | 227 | |
Kevin O'Connor | 4524bf7 | 2008-12-31 00:31:03 -0500 | [diff] [blame] | 228 | int status = send_disk_op(&dop); |
Kevin O'Connor | 74799df | 2008-03-12 20:49:07 -0400 | [diff] [blame] | 229 | |
Kevin O'Connor | 1625a75 | 2009-08-09 13:08:21 -0400 | [diff] [blame] | 230 | SET_INT13EXT(regs, count, dop.count); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 231 | |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 232 | disk_ret(regs, status); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 233 | } |
| 234 | |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 235 | |
| 236 | /**************************************************************** |
| 237 | * Hard Drive functions |
| 238 | ****************************************************************/ |
| 239 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 240 | // disk controller reset |
| 241 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 242 | disk_1300(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 243 | { |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 244 | struct disk_op_s dop; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 245 | dop.driveid = driveid; |
Kevin O'Connor | 3f6c278 | 2009-08-09 19:17:11 -0400 | [diff] [blame] | 246 | dop.command = CMD_RESET; |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 247 | int status = send_disk_op(&dop); |
| 248 | disk_ret(regs, status); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 249 | } |
| 250 | |
| 251 | // read disk status |
| 252 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 253 | disk_1301(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 254 | { |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 255 | u8 v; |
| 256 | if (regs->dl < 0x80) |
| 257 | // Floppy |
| 258 | v = GET_BDA(floppy_last_status); |
| 259 | else |
| 260 | v = GET_BDA(disk_last_status); |
Kevin O'Connor | fad2da8 | 2008-03-22 20:37:44 -0400 | [diff] [blame] | 261 | regs->ah = v; |
| 262 | set_cf(regs, v); |
| 263 | // XXX - clear disk_last_status? |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 264 | } |
| 265 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 266 | // read disk sectors |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 267 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 268 | disk_1302(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 269 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 270 | basic_access(regs, driveid, CMD_READ); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 271 | } |
| 272 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 273 | // write disk sectors |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 274 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 275 | disk_1303(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 276 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 277 | basic_access(regs, driveid, CMD_WRITE); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 278 | } |
| 279 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 280 | // verify disk sectors |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 281 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 282 | disk_1304(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 283 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 284 | basic_access(regs, driveid, CMD_VERIFY); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 285 | // FIXME verify |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 286 | } |
| 287 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 288 | // format disk track |
| 289 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 290 | disk_1305(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 291 | { |
| 292 | DISK_STUB(regs); |
| 293 | } |
| 294 | |
| 295 | // read disk drive parameters |
| 296 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 297 | disk_1308(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 298 | { |
| 299 | // Get logical geometry from table |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 300 | u16 nlc = GET_GLOBAL(Drives.drives[driveid].lchs.cylinders) - 1; |
| 301 | u16 nlh = GET_GLOBAL(Drives.drives[driveid].lchs.heads) - 1; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 302 | u16 nlspt = GET_GLOBAL(Drives.drives[driveid].lchs.spt); |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 303 | u8 count; |
| 304 | if (regs->dl < 0x80) { |
| 305 | // Floppy |
| 306 | count = GET_GLOBAL(Drives.floppycount); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 307 | |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 308 | regs->bx = GET_GLOBAL(Drives.drives[driveid].floppy_type); |
| 309 | |
| 310 | // set es & di to point to 11 byte diskette param table in ROM |
| 311 | regs->es = SEG_BIOS; |
| 312 | regs->di = (u32)&diskette_param_table2; |
| 313 | } else { |
| 314 | // Hard drive |
| 315 | count = GET_BDA(hdcount); |
| 316 | nlc--; // last sector reserved |
| 317 | } |
| 318 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 319 | regs->al = 0; |
| 320 | regs->ch = nlc & 0xff; |
| 321 | regs->cl = ((nlc >> 2) & 0xc0) | (nlspt & 0x3f); |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 322 | regs->dh = nlh; |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 323 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 324 | disk_ret(regs, DISK_RET_SUCCESS); |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 325 | regs->dl = count; |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 326 | } |
| 327 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 328 | // initialize drive parameters |
| 329 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 330 | disk_1309(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 331 | { |
| 332 | DISK_STUB(regs); |
| 333 | } |
| 334 | |
| 335 | // seek to specified cylinder |
| 336 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 337 | disk_130c(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 338 | { |
| 339 | DISK_STUB(regs); |
| 340 | } |
| 341 | |
| 342 | // alternate disk reset |
| 343 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 344 | disk_130d(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 345 | { |
| 346 | DISK_STUB(regs); |
| 347 | } |
| 348 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 349 | // check drive ready |
| 350 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 351 | disk_1310(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 352 | { |
| 353 | // should look at 40:8E also??? |
| 354 | |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 355 | struct disk_op_s dop; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 356 | dop.driveid = driveid; |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 357 | dop.command = CMD_ISREADY; |
| 358 | int status = send_disk_op(&dop); |
Kevin O'Connor | 126eac6 | 2009-08-16 13:32:24 -0400 | [diff] [blame] | 359 | disk_ret(regs, status); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 360 | } |
| 361 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 362 | // recalibrate |
| 363 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 364 | disk_1311(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 365 | { |
| 366 | DISK_STUB(regs); |
| 367 | } |
| 368 | |
| 369 | // controller internal diagnostic |
| 370 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 371 | disk_1314(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 372 | { |
| 373 | DISK_STUB(regs); |
| 374 | } |
| 375 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 376 | // read disk drive size |
| 377 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 378 | disk_1315(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 379 | { |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 380 | disk_ret(regs, DISK_RET_SUCCESS); |
| 381 | if (regs->dl < 0x80) { |
| 382 | // Floppy |
| 383 | regs->ah = 1; |
| 384 | return; |
| 385 | } |
| 386 | // Hard drive |
| 387 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 388 | // Get logical geometry from table |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 389 | u16 nlc = GET_GLOBAL(Drives.drives[driveid].lchs.cylinders); |
| 390 | u16 nlh = GET_GLOBAL(Drives.drives[driveid].lchs.heads); |
| 391 | u16 nlspt = GET_GLOBAL(Drives.drives[driveid].lchs.spt); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 392 | |
| 393 | // Compute sector count seen by int13 |
| 394 | u32 lba = (u32)(nlc - 1) * (u32)nlh * (u32)nlspt; |
| 395 | regs->cx = lba >> 16; |
| 396 | regs->dx = lba & 0xffff; |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 397 | regs->ah = 3; // hard disk accessible |
| 398 | } |
| 399 | |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 400 | static void |
| 401 | disk_1316(struct bregs *regs, u8 driveid) |
| 402 | { |
| 403 | if (regs->dl >= 0x80) { |
| 404 | // Hard drive |
| 405 | disk_ret(regs, DISK_RET_EPARAM); |
| 406 | return; |
| 407 | } |
| 408 | disk_ret(regs, DISK_RET_ECHANGED); |
| 409 | } |
| 410 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 411 | // IBM/MS installation check |
| 412 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 413 | disk_1341(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 414 | { |
| 415 | regs->bx = 0xaa55; // install check |
| 416 | regs->cx = 0x0007; // ext disk access and edd, removable supported |
| 417 | disk_ret(regs, DISK_RET_SUCCESS); |
| 418 | regs->ah = 0x30; // EDD 3.0 |
| 419 | } |
| 420 | |
| 421 | // IBM/MS extended read |
| 422 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 423 | disk_1342(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 424 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 425 | extended_access(regs, driveid, CMD_READ); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 426 | } |
| 427 | |
| 428 | // IBM/MS extended write |
| 429 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 430 | disk_1343(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 431 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 432 | extended_access(regs, driveid, CMD_WRITE); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 433 | } |
| 434 | |
| 435 | // IBM/MS verify |
| 436 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 437 | disk_1344(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 438 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 439 | extended_access(regs, driveid, CMD_VERIFY); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 440 | } |
| 441 | |
| 442 | // IBM/MS lock/unlock drive |
| 443 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 444 | disk_1345(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 445 | { |
| 446 | // Always success for HD |
| 447 | disk_ret(regs, DISK_RET_SUCCESS); |
| 448 | } |
| 449 | |
| 450 | // IBM/MS eject media |
| 451 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 452 | disk_1346(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 453 | { |
| 454 | // Volume Not Removable |
| 455 | disk_ret(regs, DISK_RET_ENOTREMOVABLE); |
| 456 | } |
| 457 | |
| 458 | // IBM/MS extended seek |
| 459 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 460 | disk_1347(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 461 | { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 462 | extended_access(regs, driveid, CMD_SEEK); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 463 | } |
| 464 | |
| 465 | // IBM/MS get drive parameters |
| 466 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 467 | disk_1348(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 468 | { |
| 469 | u16 size = GET_INT13DPT(regs, size); |
| 470 | |
| 471 | // Buffer is too small |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 472 | if (size < 26) { |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 473 | disk_ret(regs, DISK_RET_EPARAM); |
| 474 | return; |
| 475 | } |
| 476 | |
| 477 | // EDD 1.x |
| 478 | |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 479 | u8 type = GET_GLOBAL(Drives.drives[driveid].type); |
| 480 | u16 npc = GET_GLOBAL(Drives.drives[driveid].pchs.cylinders); |
| 481 | u16 nph = GET_GLOBAL(Drives.drives[driveid].pchs.heads); |
| 482 | u16 npspt = GET_GLOBAL(Drives.drives[driveid].pchs.spt); |
| 483 | u64 lba = GET_GLOBAL(Drives.drives[driveid].sectors); |
| 484 | u16 blksize = GET_GLOBAL(Drives.drives[driveid].blksize); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 485 | |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 486 | dprintf(DEBUG_HDL_13, "disk_1348 size=%d t=%d chs=%d,%d,%d lba=%d bs=%d\n" |
| 487 | , size, type, npc, nph, npspt, (u32)lba, blksize); |
| 488 | |
| 489 | SET_INT13DPT(regs, size, 26); |
Kevin O'Connor | b114436 | 2009-08-11 20:43:38 -0400 | [diff] [blame] | 490 | if (type == DTYPE_ATAPI) { |
| 491 | // 0x74 = removable, media change, lockable, max values |
| 492 | SET_INT13DPT(regs, infos, 0x74); |
| 493 | SET_INT13DPT(regs, cylinders, 0xffffffff); |
| 494 | SET_INT13DPT(regs, heads, 0xffffffff); |
| 495 | SET_INT13DPT(regs, spt, 0xffffffff); |
| 496 | SET_INT13DPT(regs, sector_count, (u64)-1); |
| 497 | } else { |
Kevin O'Connor | 1bb3b5c | 2008-05-14 00:43:13 -0400 | [diff] [blame] | 498 | if (lba > (u64)npspt*nph*0x3fff) { |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 499 | SET_INT13DPT(regs, infos, 0x00); // geometry is invalid |
| 500 | SET_INT13DPT(regs, cylinders, 0x3fff); |
| 501 | } else { |
| 502 | SET_INT13DPT(regs, infos, 0x02); // geometry is valid |
| 503 | SET_INT13DPT(regs, cylinders, (u32)npc); |
| 504 | } |
| 505 | SET_INT13DPT(regs, heads, (u32)nph); |
| 506 | SET_INT13DPT(regs, spt, (u32)npspt); |
Kevin O'Connor | 1bb3b5c | 2008-05-14 00:43:13 -0400 | [diff] [blame] | 507 | SET_INT13DPT(regs, sector_count, lba); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 508 | } |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 509 | SET_INT13DPT(regs, blksize, blksize); |
| 510 | |
Kevin O'Connor | b114436 | 2009-08-11 20:43:38 -0400 | [diff] [blame] | 511 | if (size < 30 || (type != DTYPE_ATA && type != DTYPE_ATAPI)) { |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 512 | disk_ret(regs, DISK_RET_SUCCESS); |
| 513 | return; |
| 514 | } |
| 515 | |
| 516 | // EDD 2.x |
| 517 | |
Kevin O'Connor | 0881537 | 2008-12-29 21:16:31 -0500 | [diff] [blame] | 518 | u16 ebda_seg = get_ebda_seg(); |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 519 | SET_INT13DPT(regs, size, 30); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 520 | |
Kevin O'Connor | 0881537 | 2008-12-29 21:16:31 -0500 | [diff] [blame] | 521 | SET_INT13DPT(regs, dpte_segment, ebda_seg); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 522 | SET_INT13DPT(regs, dpte_offset |
Kevin O'Connor | 609da23 | 2008-12-28 23:18:57 -0500 | [diff] [blame] | 523 | , offsetof(struct extended_bios_data_area_s, dpte)); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 524 | |
| 525 | // Fill in dpte |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 526 | u8 ataid = GET_GLOBAL(Drives.drives[driveid].cntl_id); |
Kevin O'Connor | b114436 | 2009-08-11 20:43:38 -0400 | [diff] [blame] | 527 | u8 channel = ataid / 2; |
| 528 | u8 slave = ataid % 2; |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 529 | u16 iobase1 = GET_GLOBAL(ATA_channels[channel].iobase1); |
| 530 | u16 iobase2 = GET_GLOBAL(ATA_channels[channel].iobase2); |
| 531 | u8 irq = GET_GLOBAL(ATA_channels[channel].irq); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 532 | |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 533 | u16 options = 0; |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 534 | if (type == DTYPE_ATA) { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 535 | u8 translation = GET_GLOBAL(Drives.drives[driveid].translation); |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 536 | if (translation != TRANSLATION_NONE) { |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 537 | options |= 1<<3; // CHS translation |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 538 | if (translation == TRANSLATION_LBA) |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 539 | options |= 1<<9; |
Kevin O'Connor | 4233766 | 2009-08-10 00:06:37 -0400 | [diff] [blame] | 540 | if (translation == TRANSLATION_RECHS) |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 541 | options |= 3<<9; |
| 542 | } |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 543 | } else { |
| 544 | // ATAPI |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 545 | options |= 1<<5; // removable device |
| 546 | options |= 1<<6; // atapi device |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 547 | } |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 548 | options |= 1<<4; // lba translation |
Kevin O'Connor | 32945af | 2009-02-27 21:23:01 -0500 | [diff] [blame] | 549 | if (CONFIG_ATA_PIO32) |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 550 | options |= 1<<7; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 551 | |
Kevin O'Connor | 0881537 | 2008-12-29 21:16:31 -0500 | [diff] [blame] | 552 | SET_EBDA2(ebda_seg, dpte.iobase1, iobase1); |
| 553 | SET_EBDA2(ebda_seg, dpte.iobase2, iobase2 + ATA_CB_DC); |
| 554 | SET_EBDA2(ebda_seg, dpte.prefix, ((slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0) |
| 555 | | ATA_CB_DH_LBA)); |
| 556 | SET_EBDA2(ebda_seg, dpte.unused, 0xcb); |
| 557 | SET_EBDA2(ebda_seg, dpte.irq, irq); |
| 558 | SET_EBDA2(ebda_seg, dpte.blkcount, 1); |
| 559 | SET_EBDA2(ebda_seg, dpte.dma, 0); |
| 560 | SET_EBDA2(ebda_seg, dpte.pio, 0); |
| 561 | SET_EBDA2(ebda_seg, dpte.options, options); |
| 562 | SET_EBDA2(ebda_seg, dpte.reserved, 0); |
| 563 | SET_EBDA2(ebda_seg, dpte.revision, 0x11); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 564 | |
Kevin O'Connor | 8b267cb | 2009-01-19 19:25:21 -0500 | [diff] [blame] | 565 | u8 sum = checksum_far( |
| 566 | ebda_seg, (void*)offsetof(struct extended_bios_data_area_s, dpte), 15); |
| 567 | SET_EBDA2(ebda_seg, dpte.checksum, -sum); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 568 | |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 569 | if (size < 66) { |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 570 | disk_ret(regs, DISK_RET_SUCCESS); |
| 571 | return; |
| 572 | } |
| 573 | |
| 574 | // EDD 3.x |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 575 | SET_INT13DPT(regs, key, 0xbedd); |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 576 | SET_INT13DPT(regs, dpi_length, 36); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 577 | SET_INT13DPT(regs, reserved1, 0); |
| 578 | SET_INT13DPT(regs, reserved2, 0); |
| 579 | |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 580 | SET_INT13DPT(regs, host_bus[0], 'P'); |
| 581 | SET_INT13DPT(regs, host_bus[1], 'C'); |
| 582 | SET_INT13DPT(regs, host_bus[2], 'I'); |
| 583 | SET_INT13DPT(regs, host_bus[3], 0); |
| 584 | |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 585 | u32 bdf = GET_GLOBAL(ATA_channels[channel].pci_bdf); |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 586 | u32 path = (pci_bdf_to_bus(bdf) | (pci_bdf_to_dev(bdf) << 8) |
| 587 | | (pci_bdf_to_fn(bdf) << 16)); |
| 588 | SET_INT13DPT(regs, iface_path, path); |
| 589 | |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 590 | SET_INT13DPT(regs, iface_type[0], 'A'); |
| 591 | SET_INT13DPT(regs, iface_type[1], 'T'); |
| 592 | SET_INT13DPT(regs, iface_type[2], 'A'); |
| 593 | SET_INT13DPT(regs, iface_type[3], 0); |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 594 | SET_INT13DPT(regs, iface_type[4], 0); |
| 595 | SET_INT13DPT(regs, iface_type[5], 0); |
| 596 | SET_INT13DPT(regs, iface_type[6], 0); |
| 597 | SET_INT13DPT(regs, iface_type[7], 0); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 598 | |
Kevin O'Connor | 970a032 | 2008-10-26 12:01:21 -0400 | [diff] [blame] | 599 | SET_INT13DPT(regs, device_path, slave); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 600 | |
Kevin O'Connor | 7d10821 | 2009-01-21 19:13:21 -0500 | [diff] [blame] | 601 | SET_INT13DPT(regs, checksum |
| 602 | , -checksum_far(regs->ds, (void*)(regs->si+30), 35)); |
Kevin O'Connor | 53236cc | 2008-08-31 11:16:33 -0400 | [diff] [blame] | 603 | |
| 604 | disk_ret(regs, DISK_RET_SUCCESS); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 605 | } |
| 606 | |
| 607 | // IBM/MS extended media change |
| 608 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 609 | disk_1349(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 610 | { |
| 611 | // Always success for HD |
| 612 | disk_ret(regs, DISK_RET_SUCCESS); |
| 613 | } |
| 614 | |
| 615 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 616 | disk_134e01(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 617 | { |
| 618 | disk_ret(regs, DISK_RET_SUCCESS); |
| 619 | } |
| 620 | |
| 621 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 622 | disk_134e03(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 623 | { |
| 624 | disk_ret(regs, DISK_RET_SUCCESS); |
| 625 | } |
| 626 | |
| 627 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 628 | disk_134e04(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 629 | { |
| 630 | disk_ret(regs, DISK_RET_SUCCESS); |
| 631 | } |
| 632 | |
| 633 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 634 | disk_134e06(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 635 | { |
| 636 | disk_ret(regs, DISK_RET_SUCCESS); |
| 637 | } |
| 638 | |
| 639 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 640 | disk_134eXX(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 641 | { |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 642 | disk_ret(regs, DISK_RET_EPARAM); |
| 643 | } |
| 644 | |
| 645 | // IBM/MS set hardware configuration |
| 646 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 647 | disk_134e(struct bregs *regs, u8 driveid) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 648 | { |
| 649 | switch (regs->al) { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 650 | case 0x01: disk_134e01(regs, driveid); break; |
| 651 | case 0x03: disk_134e03(regs, driveid); break; |
| 652 | case 0x04: disk_134e04(regs, driveid); break; |
| 653 | case 0x06: disk_134e06(regs, driveid); break; |
| 654 | default: disk_134eXX(regs, driveid); break; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 655 | } |
| 656 | } |
| 657 | |
Kevin O'Connor | 31d8c8a | 2008-03-04 19:56:41 -0500 | [diff] [blame] | 658 | void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 659 | disk_13XX(struct bregs *regs, u8 driveid) |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 660 | { |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 661 | disk_ret(regs, DISK_RET_EPARAM); |
| 662 | } |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 663 | |
Kevin O'Connor | 31d8c8a | 2008-03-04 19:56:41 -0500 | [diff] [blame] | 664 | void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 665 | disk_13(struct bregs *regs, u8 driveid) |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 666 | { |
Kevin O'Connor | 15aee2e | 2008-03-01 13:34:04 -0500 | [diff] [blame] | 667 | //debug_stub(regs); |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 668 | |
| 669 | // clear completion flag |
| 670 | SET_BDA(disk_interrupt_flag, 0); |
| 671 | |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 672 | switch (regs->ah) { |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 673 | case 0x00: disk_1300(regs, driveid); break; |
| 674 | case 0x01: disk_1301(regs, driveid); break; |
| 675 | case 0x02: disk_1302(regs, driveid); break; |
| 676 | case 0x03: disk_1303(regs, driveid); break; |
| 677 | case 0x04: disk_1304(regs, driveid); break; |
| 678 | case 0x05: disk_1305(regs, driveid); break; |
| 679 | case 0x08: disk_1308(regs, driveid); break; |
| 680 | case 0x09: disk_1309(regs, driveid); break; |
| 681 | case 0x0c: disk_130c(regs, driveid); break; |
| 682 | case 0x0d: disk_130d(regs, driveid); break; |
| 683 | case 0x10: disk_1310(regs, driveid); break; |
| 684 | case 0x11: disk_1311(regs, driveid); break; |
| 685 | case 0x14: disk_1314(regs, driveid); break; |
| 686 | case 0x15: disk_1315(regs, driveid); break; |
Kevin O'Connor | 48410fd | 2009-08-16 14:13:36 -0400 | [diff] [blame^] | 687 | case 0x16: disk_1316(regs, driveid); break; |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 688 | case 0x41: disk_1341(regs, driveid); break; |
| 689 | case 0x42: disk_1342(regs, driveid); break; |
| 690 | case 0x43: disk_1343(regs, driveid); break; |
| 691 | case 0x44: disk_1344(regs, driveid); break; |
| 692 | case 0x45: disk_1345(regs, driveid); break; |
| 693 | case 0x46: disk_1346(regs, driveid); break; |
| 694 | case 0x47: disk_1347(regs, driveid); break; |
| 695 | case 0x48: disk_1348(regs, driveid); break; |
| 696 | case 0x49: disk_1349(regs, driveid); break; |
| 697 | case 0x4e: disk_134e(regs, driveid); break; |
| 698 | default: disk_13XX(regs, driveid); break; |
Kevin O'Connor | 3491e8b | 2008-02-29 00:22:27 -0500 | [diff] [blame] | 699 | } |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 700 | } |
| 701 | |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 702 | |
| 703 | /**************************************************************** |
Kevin O'Connor | b74102d | 2008-03-03 21:57:30 -0500 | [diff] [blame] | 704 | * Entry points |
| 705 | ****************************************************************/ |
| 706 | |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 707 | static int |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 708 | get_driveid(struct bregs *regs, u8 exttype, u8 extdriveoffset) |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 709 | { |
| 710 | // basic check : device has to be defined |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 711 | if (extdriveoffset >= ARRAY_SIZE(Drives.idmap[0])) |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 712 | return -1; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 713 | |
| 714 | // Get the ata channel |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 715 | u8 driveid = GET_GLOBAL(Drives.idmap[exttype][extdriveoffset]); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 716 | |
| 717 | // basic check : device has to be valid |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 718 | if (driveid >= ARRAY_SIZE(Drives.drives)) |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 719 | return -1; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 720 | |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 721 | return driveid; |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 722 | } |
| 723 | |
| 724 | static void |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 725 | handle_legacy_disk(struct bregs *regs, u8 extdrive) |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 726 | { |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 727 | if (! CONFIG_DRIVES) { |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 728 | // XXX - support handle_1301 anyway? |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 729 | disk_ret(regs, DISK_RET_EPARAM); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 730 | return; |
| 731 | } |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 732 | |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 733 | if (extdrive < 0x80) { |
| 734 | int driveid = get_driveid(regs, EXTTYPE_FLOPPY, extdrive); |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 735 | if (driveid < 0) |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 736 | goto fail; |
| 737 | floppy_13(regs, driveid); |
| 738 | return; |
| 739 | } |
| 740 | |
| 741 | if (extdrive >= 0xe0) { |
| 742 | int driveid = get_driveid(regs, EXTTYPE_CD, extdrive - 0xe0); |
| 743 | if (driveid < 0) |
| 744 | goto fail; |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 745 | cdrom_13(regs, driveid); |
Kevin O'Connor | e43df9e | 2008-03-01 22:16:32 -0500 | [diff] [blame] | 746 | return; |
| 747 | } |
| 748 | |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 749 | int driveid = get_driveid(regs, EXTTYPE_HD, extdrive - 0x80); |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 750 | if (driveid < 0) |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 751 | goto fail; |
Kevin O'Connor | c892b13 | 2009-08-11 21:59:37 -0400 | [diff] [blame] | 752 | disk_13(regs, driveid); |
Kevin O'Connor | 0a0e42e | 2009-08-16 12:09:44 -0400 | [diff] [blame] | 753 | return; |
| 754 | |
| 755 | fail: |
| 756 | // XXX - support 1301/1308/1315 anyway? |
| 757 | disk_ret(regs, DISK_RET_EPARAM); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 758 | } |
| 759 | |
Kevin O'Connor | 1978676 | 2008-03-05 21:09:59 -0500 | [diff] [blame] | 760 | void VISIBLE16 |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 761 | handle_40(struct bregs *regs) |
| 762 | { |
Kevin O'Connor | 15c1f22 | 2008-06-12 22:59:43 -0400 | [diff] [blame] | 763 | debug_enter(regs, DEBUG_HDL_40); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 764 | handle_legacy_disk(regs, regs->dl); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 765 | } |
| 766 | |
| 767 | // INT 13h Fixed Disk Services Entry Point |
Kevin O'Connor | 1978676 | 2008-03-05 21:09:59 -0500 | [diff] [blame] | 768 | void VISIBLE16 |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 769 | handle_13(struct bregs *regs) |
| 770 | { |
Kevin O'Connor | 15c1f22 | 2008-06-12 22:59:43 -0400 | [diff] [blame] | 771 | debug_enter(regs, DEBUG_HDL_13); |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 772 | u8 extdrive = regs->dl; |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 773 | |
Kevin O'Connor | dfa1650 | 2008-03-22 20:13:08 -0400 | [diff] [blame] | 774 | if (CONFIG_CDROM_EMU) { |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 775 | if (regs->ah == 0x4b) { |
| 776 | cdemu_134b(regs); |
Kevin O'Connor | 6c78122 | 2008-03-09 12:19:23 -0400 | [diff] [blame] | 777 | return; |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 778 | } |
Kevin O'Connor | 4a16ef6 | 2008-12-31 00:09:28 -0500 | [diff] [blame] | 779 | u16 ebda_seg = get_ebda_seg(); |
| 780 | if (GET_EBDA2(ebda_seg, cdemu.active)) { |
Kevin O'Connor | 669e644 | 2009-08-11 22:36:30 -0400 | [diff] [blame] | 781 | u8 emudrive = GET_EBDA2(ebda_seg, cdemu.emulated_extdrive); |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 782 | if (extdrive == emudrive) { |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 783 | cdemu_13(regs); |
Kevin O'Connor | 6c78122 | 2008-03-09 12:19:23 -0400 | [diff] [blame] | 784 | return; |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 785 | } |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 786 | if (extdrive < 0xe0 && ((emudrive ^ extdrive) & 0x80) == 0) |
| 787 | extdrive--; |
Kevin O'Connor | 941d3e4 | 2008-03-04 19:45:04 -0500 | [diff] [blame] | 788 | } |
| 789 | } |
Kevin O'Connor | 707298a | 2009-08-11 22:27:51 -0400 | [diff] [blame] | 790 | handle_legacy_disk(regs, extdrive); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 791 | } |
| 792 | |
| 793 | // record completion in BIOS task complete flag |
Kevin O'Connor | 1978676 | 2008-03-05 21:09:59 -0500 | [diff] [blame] | 794 | void VISIBLE16 |
Kevin O'Connor | ed12849 | 2008-03-11 11:14:59 -0400 | [diff] [blame] | 795 | handle_76() |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 796 | { |
Kevin O'Connor | 15c1f22 | 2008-06-12 22:59:43 -0400 | [diff] [blame] | 797 | debug_isr(DEBUG_ISR_76); |
Kevin O'Connor | ed12849 | 2008-03-11 11:14:59 -0400 | [diff] [blame] | 798 | SET_BDA(disk_interrupt_flag, 0xff); |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 799 | eoi_pic2(); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 800 | } |
Kevin O'Connor | 3085376 | 2009-01-17 18:49:20 -0500 | [diff] [blame] | 801 | |
| 802 | // Old Fixed Disk Parameter Table (newer tables are in the ebda). |
| 803 | struct fdpt_s OldFDPT VAR16FIXED(0xe401); |