1 | /* $Id: disk.c 82163 2019-11-25 10:31:53Z vboxsync $ */
|
---|
2 | /** @file
|
---|
3 | * PC BIOS - ???
|
---|
4 | */
|
---|
5 |
|
---|
6 | /*
|
---|
7 | * Copyright (C) 2006-2019 Oracle Corporation
|
---|
8 | *
|
---|
9 | * This file is part of VirtualBox Open Source Edition (OSE), as
|
---|
10 | * available from http://www.virtualbox.org. This file is free software;
|
---|
11 | * you can redistribute it and/or modify it under the terms of the GNU
|
---|
12 | * General Public License (GPL) as published by the Free Software
|
---|
13 | * Foundation, in version 2 as it comes in the "COPYING" file of the
|
---|
14 | * VirtualBox OSE distribution. VirtualBox OSE is distributed in the
|
---|
15 | * hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
|
---|
16 | * --------------------------------------------------------------------
|
---|
17 | *
|
---|
18 | * This code is based on:
|
---|
19 | *
|
---|
20 | * ROM BIOS for use with Bochs/Plex86/QEMU emulation environment
|
---|
21 | *
|
---|
22 | * Copyright (C) 2002 MandrakeSoft S.A.
|
---|
23 | *
|
---|
24 | * MandrakeSoft S.A.
|
---|
25 | * 43, rue d'Aboukir
|
---|
26 | * 75002 Paris - France
|
---|
27 | * http://www.linux-mandrake.com/
|
---|
28 | * http://www.mandrakesoft.com/
|
---|
29 | *
|
---|
30 | * This library is free software; you can redistribute it and/or
|
---|
31 | * modify it under the terms of the GNU Lesser General Public
|
---|
32 | * License as published by the Free Software Foundation; either
|
---|
33 | * version 2 of the License, or (at your option) any later version.
|
---|
34 | *
|
---|
35 | * This library is distributed in the hope that it will be useful,
|
---|
36 | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
37 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
---|
38 | * Lesser General Public License for more details.
|
---|
39 | *
|
---|
40 | * You should have received a copy of the GNU Lesser General Public
|
---|
41 | * License along with this library; if not, write to the Free Software
|
---|
42 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
---|
43 | *
|
---|
44 | */
|
---|
45 |
|
---|
46 | /*
|
---|
47 | * Oracle LGPL Disclaimer: For the avoidance of doubt, except that if any license choice
|
---|
48 | * other than GPL or LGPL is available it will apply instead, Oracle elects to use only
|
---|
49 | * the Lesser General Public License version 2.1 (LGPLv2) at this time for any software where
|
---|
50 | * a choice of LGPL license versions is made available with the language indicating
|
---|
51 | * that LGPLv2 or any later version may be used, or where a choice of which version
|
---|
52 | * of the LGPL is applied is otherwise unspecified.
|
---|
53 | */
|
---|
54 |
|
---|
55 |
|
---|
56 | #include <stdint.h>
|
---|
57 | #include "biosint.h"
|
---|
58 | #include "inlines.h"
|
---|
59 | #include "ebda.h"
|
---|
60 | #include "ata.h"
|
---|
61 |
|
---|
62 |
|
---|
63 | #if DEBUG_INT13_HD
|
---|
64 | # define BX_DEBUG_INT13_HD(...) BX_DEBUG(__VA_ARGS__)
|
---|
65 | #else
|
---|
66 | # define BX_DEBUG_INT13_HD(...)
|
---|
67 | #endif
|
---|
68 |
|
---|
69 | /* Generic disk read/write routine signature. */
|
---|
70 | typedef __fastcall (* dsk_rw_func)(bio_dsk_t __far *bios_dsk);
|
---|
71 |
|
---|
72 | /* Controller specific disk access routines. Declared as a union to reduce
|
---|
73 | * the need for conditionals when choosing between read/write functions.
|
---|
74 | * Note that we get away with using near pointers, which is nice.
|
---|
75 | */
|
---|
76 | typedef union {
|
---|
77 | struct {
|
---|
78 | dsk_rw_func read;
|
---|
79 | dsk_rw_func write;
|
---|
80 | } s;
|
---|
81 | dsk_rw_func a[2];
|
---|
82 | } dsk_acc_t;
|
---|
83 |
|
---|
84 | /* Pointers to HW specific disk access routines. */
|
---|
85 | dsk_acc_t dskacc[DSKTYP_CNT] = {
|
---|
86 | [DSK_TYPE_ATA] = { ata_read_sectors, ata_write_sectors },
|
---|
87 | #ifdef VBOX_WITH_AHCI
|
---|
88 | [DSK_TYPE_AHCI] = { ahci_read_sectors, ahci_write_sectors },
|
---|
89 | #endif
|
---|
90 | #ifdef VBOX_WITH_SCSI
|
---|
91 | [DSK_TYPE_SCSI] = { scsi_read_sectors, scsi_write_sectors },
|
---|
92 | #endif
|
---|
93 | #ifdef VBOX_WITH_VIRTIO_SCSI
|
---|
94 | [DSK_TYPE_VIRTIO_SCSI] = { virtio_scsi_read_sectors, virtio_scsi_write_sectors },
|
---|
95 | #endif
|
---|
96 | };
|
---|
97 |
|
---|
98 |
|
---|
99 | /// @todo put in a header
|
---|
100 | #define AX r.gr.u.r16.ax
|
---|
101 | #define BX r.gr.u.r16.bx
|
---|
102 | #define CX r.gr.u.r16.cx
|
---|
103 | #define DX r.gr.u.r16.dx
|
---|
104 | #define SI r.gr.u.r16.si
|
---|
105 | #define DI r.gr.u.r16.di
|
---|
106 | #define BP r.gr.u.r16.bp
|
---|
107 | #define ELDX r.gr.u.r16.sp
|
---|
108 | #define DS r.ds
|
---|
109 | #define ES r.es
|
---|
110 | #define FLAGS r.ra.flags.u.r16.flags
|
---|
111 |
|
---|
112 |
|
---|
113 | /*
|
---|
114 | * Build translated CHS geometry given a disk size in sectors. Based on
|
---|
115 | * Phoenix EDD 3.0. This is used as a fallback to generate sane logical
|
---|
116 | * geometry in case none was provided in CMOS.
|
---|
117 | */
|
---|
118 | void set_geom_lba(chs_t __far *lgeo, uint64_t nsectors64)
|
---|
119 | {
|
---|
120 | uint32_t limit = 8257536; /* 1024 * 128 * 63 */
|
---|
121 | uint32_t nsectors;
|
---|
122 | unsigned heads = 255;
|
---|
123 | int i;
|
---|
124 |
|
---|
125 | nsectors = (nsectors64 >> 32) ? 0xFFFFFFFFL : (uint32_t)nsectors64;
|
---|
126 | /* Start with ~4GB limit, go down to 504MB. */
|
---|
127 | for (i = 0; i < 4; ++i) {
|
---|
128 | if (nsectors <= limit)
|
---|
129 | heads = (heads + 1) / 2;
|
---|
130 | limit /= 2;
|
---|
131 | }
|
---|
132 |
|
---|
133 | lgeo->cylinders = nsectors / (heads * 63UL);
|
---|
134 | if (lgeo->cylinders > 1024)
|
---|
135 | lgeo->cylinders = 1024;
|
---|
136 | lgeo->heads = heads;
|
---|
137 | lgeo->spt = 63; /* Always 63 sectors per track, the maximum. */
|
---|
138 | }
|
---|
139 |
|
---|
140 | int edd_fill_dpt(dpt_t __far *dpt, bio_dsk_t __far *bios_dsk, uint8_t device)
|
---|
141 | {
|
---|
142 | uint16_t ebda_seg = read_word(0x0040,0x000E);
|
---|
143 |
|
---|
144 | /* Check if buffer is large enough. */
|
---|
145 | if (dpt->size < 0x1a)
|
---|
146 | return -1;
|
---|
147 |
|
---|
148 | /* Fill in EDD 1.x table. */
|
---|
149 | if (dpt->size >= 0x1a) {
|
---|
150 | uint64_t lba;
|
---|
151 |
|
---|
152 | dpt->size = 0x1a;
|
---|
153 | dpt->blksize = bios_dsk->devices[device].blksize;
|
---|
154 |
|
---|
155 | if (bios_dsk->devices[device].device == DSK_DEVICE_CDROM) {
|
---|
156 | dpt->infos = 0x74; /* Removable, media change, lockable, max values */
|
---|
157 | dpt->cylinders = 0xffffffff;
|
---|
158 | dpt->heads = 0xffffffff;
|
---|
159 | dpt->spt = 0xffffffff;
|
---|
160 | dpt->sector_count1 = 0xffffffff;
|
---|
161 | dpt->sector_count2 = 0xffffffff;
|
---|
162 | } else {
|
---|
163 | dpt->infos = 0x02; // geometry is valid
|
---|
164 | dpt->cylinders = bios_dsk->devices[device].pchs.cylinders;
|
---|
165 | dpt->heads = bios_dsk->devices[device].pchs.heads;
|
---|
166 | dpt->spt = bios_dsk->devices[device].pchs.spt;
|
---|
167 | lba = bios_dsk->devices[device].sectors;
|
---|
168 | dpt->sector_count1 = lba;
|
---|
169 | dpt->sector_count2 = lba >> 32;
|
---|
170 | }
|
---|
171 | }
|
---|
172 |
|
---|
173 | /* Fill in EDD 2.x table. */
|
---|
174 | if (dpt->size >= 0x1e) {
|
---|
175 | uint8_t channel, irq, mode, checksum, i, xlation;
|
---|
176 | uint16_t iobase1, iobase2, options;
|
---|
177 |
|
---|
178 | dpt->size = 0x1e;
|
---|
179 | dpt->dpte_segment = ebda_seg;
|
---|
180 | dpt->dpte_offset = (uint16_t)&EbdaData->bdisk.dpte;
|
---|
181 |
|
---|
182 | // Fill in dpte
|
---|
183 | channel = device / 2;
|
---|
184 | iobase1 = bios_dsk->channels[channel].iobase1;
|
---|
185 | iobase2 = bios_dsk->channels[channel].iobase2;
|
---|
186 | irq = bios_dsk->channels[channel].irq;
|
---|
187 | mode = bios_dsk->devices[device].mode;
|
---|
188 | xlation = bios_dsk->devices[device].translation;
|
---|
189 |
|
---|
190 | options = (xlation == GEO_TRANSLATION_NONE ? 0 : 1 << 3); /* CHS translation */
|
---|
191 | options |= (1 << 4); /* LBA translation */
|
---|
192 | if (bios_dsk->devices[device].device == DSK_DEVICE_CDROM) {
|
---|
193 | options |= (1 << 5); /* Removable device */
|
---|
194 | options |= (1 << 6); /* ATAPI device */
|
---|
195 | }
|
---|
196 | #if VBOX_BIOS_CPU >= 80386
|
---|
197 | options |= (mode == ATA_MODE_PIO32 ? 1 : 0 << 7);
|
---|
198 | #endif
|
---|
199 | options |= (xlation == GEO_TRANSLATION_LBA ? 1 : 0 << 9);
|
---|
200 | options |= (xlation == GEO_TRANSLATION_RECHS ? 3 : 0 << 9);
|
---|
201 |
|
---|
202 | bios_dsk->dpte.iobase1 = iobase1;
|
---|
203 | bios_dsk->dpte.iobase2 = iobase2;
|
---|
204 | bios_dsk->dpte.prefix = (0xe | (device % 2)) << 4;
|
---|
205 | bios_dsk->dpte.unused = 0xcb;
|
---|
206 | bios_dsk->dpte.irq = irq;
|
---|
207 | bios_dsk->dpte.blkcount = 1;
|
---|
208 | bios_dsk->dpte.dma = 0;
|
---|
209 | bios_dsk->dpte.pio = 0;
|
---|
210 | bios_dsk->dpte.options = options;
|
---|
211 | bios_dsk->dpte.reserved = 0;
|
---|
212 | bios_dsk->dpte.revision = 0x11;
|
---|
213 |
|
---|
214 | checksum = 0;
|
---|
215 | for (i = 0; i < 15; ++i)
|
---|
216 | checksum += read_byte(ebda_seg, (uint16_t)&EbdaData->bdisk.dpte + i);
|
---|
217 | checksum = -checksum;
|
---|
218 | bios_dsk->dpte.checksum = checksum;
|
---|
219 | }
|
---|
220 |
|
---|
221 | /* Fill in EDD 3.x table. */
|
---|
222 | if (dpt->size >= 0x42) {
|
---|
223 | uint8_t channel, iface, checksum, i;
|
---|
224 | uint16_t iobase1;
|
---|
225 |
|
---|
226 | channel = device / 2;
|
---|
227 | iface = bios_dsk->channels[channel].iface;
|
---|
228 | iobase1 = bios_dsk->channels[channel].iobase1;
|
---|
229 |
|
---|
230 | dpt->size = 0x42;
|
---|
231 | dpt->key = 0xbedd;
|
---|
232 | dpt->dpi_length = 0x24;
|
---|
233 | dpt->reserved1 = 0;
|
---|
234 | dpt->reserved2 = 0;
|
---|
235 |
|
---|
236 | if (iface == ATA_IFACE_ISA) {
|
---|
237 | dpt->host_bus[0] = 'I';
|
---|
238 | dpt->host_bus[1] = 'S';
|
---|
239 | dpt->host_bus[2] = 'A';
|
---|
240 | dpt->host_bus[3] = ' ';
|
---|
241 | }
|
---|
242 | else {
|
---|
243 | // FIXME PCI
|
---|
244 | }
|
---|
245 | dpt->iface_type[0] = 'A';
|
---|
246 | dpt->iface_type[1] = 'T';
|
---|
247 | dpt->iface_type[2] = 'A';
|
---|
248 | dpt->iface_type[3] = ' ';
|
---|
249 | dpt->iface_type[4] = ' ';
|
---|
250 | dpt->iface_type[5] = ' ';
|
---|
251 | dpt->iface_type[6] = ' ';
|
---|
252 | dpt->iface_type[7] = ' ';
|
---|
253 |
|
---|
254 | if (iface == ATA_IFACE_ISA) {
|
---|
255 | ((uint16_t __far *)dpt->iface_path)[0] = iobase1;
|
---|
256 | ((uint16_t __far *)dpt->iface_path)[1] = 0;
|
---|
257 | ((uint32_t __far *)dpt->iface_path)[1] = 0;
|
---|
258 | }
|
---|
259 | else {
|
---|
260 | // FIXME PCI
|
---|
261 | }
|
---|
262 | ((uint16_t __far *)dpt->device_path)[0] = device & 1; // device % 2; @todo: correct?
|
---|
263 | ((uint16_t __far *)dpt->device_path)[1] = 0;
|
---|
264 | ((uint32_t __far *)dpt->device_path)[1] = 0;
|
---|
265 |
|
---|
266 | checksum = 0;
|
---|
267 | for (i = 30; i < 64; i++)
|
---|
268 | checksum += ((uint8_t __far *)dpt)[i];
|
---|
269 | checksum = -checksum;
|
---|
270 | dpt->checksum = checksum;
|
---|
271 | }
|
---|
272 | return 0;
|
---|
273 | }
|
---|
274 |
|
---|
275 | void BIOSCALL int13_harddisk(disk_regs_t r)
|
---|
276 | {
|
---|
277 | uint32_t lba;
|
---|
278 | uint16_t cylinder, head, sector;
|
---|
279 | uint16_t nlc, nlh, nlspt;
|
---|
280 | uint16_t count;
|
---|
281 | uint8_t device, status;
|
---|
282 | bio_dsk_t __far *bios_dsk;
|
---|
283 |
|
---|
284 | BX_DEBUG_INT13_HD("%s: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", __func__, AX, BX, CX, DX, ES);
|
---|
285 |
|
---|
286 | SET_IF(); /* INT 13h always returns with interrupts enabled. */
|
---|
287 |
|
---|
288 | bios_dsk = read_word(0x0040,0x000E) :> &EbdaData->bdisk;
|
---|
289 | write_byte(0x0040, 0x008e, 0); // clear completion flag
|
---|
290 |
|
---|
291 | // basic check : device has to be defined
|
---|
292 | if ( (GET_ELDL() < 0x80) || (GET_ELDL() >= 0x80 + BX_MAX_STORAGE_DEVICES) ) {
|
---|
293 | BX_DEBUG("%s: function %02x, ELDL out of range %02x\n", __func__, GET_AH(), GET_ELDL());
|
---|
294 | goto int13_fail;
|
---|
295 | }
|
---|
296 |
|
---|
297 | // Get the ata channel
|
---|
298 | device = bios_dsk->hdidmap[GET_ELDL()-0x80];
|
---|
299 |
|
---|
300 | // basic check : device has to be valid
|
---|
301 | if (device >= BX_MAX_STORAGE_DEVICES) {
|
---|
302 | BX_DEBUG("%s: function %02x, unmapped device for ELDL=%02x\n", __func__, GET_AH(), GET_ELDL());
|
---|
303 | goto int13_fail;
|
---|
304 | }
|
---|
305 |
|
---|
306 | switch (GET_AH()) {
|
---|
307 |
|
---|
308 | case 0x00: /* disk controller reset */
|
---|
309 | #ifdef VBOX_WITH_SCSI
|
---|
310 | /* SCSI controller does not need a reset. */
|
---|
311 | if (!VBOX_IS_SCSI_DEVICE(device))
|
---|
312 | #endif
|
---|
313 | ata_reset (device);
|
---|
314 | goto int13_success;
|
---|
315 | break;
|
---|
316 |
|
---|
317 | case 0x01: /* read disk status */
|
---|
318 | status = read_byte(0x0040, 0x0074);
|
---|
319 | SET_AH(status);
|
---|
320 | SET_DISK_RET_STATUS(0);
|
---|
321 | /* set CF if error status read */
|
---|
322 | if (status) goto int13_fail_nostatus;
|
---|
323 | else goto int13_success_noah;
|
---|
324 | break;
|
---|
325 |
|
---|
326 | case 0x02: // read disk sectors
|
---|
327 | case 0x03: // write disk sectors
|
---|
328 | case 0x04: // verify disk sectors
|
---|
329 |
|
---|
330 | count = GET_AL();
|
---|
331 | cylinder = GET_CH();
|
---|
332 | cylinder |= ( ((uint16_t) GET_CL()) << 2) & 0x300;
|
---|
333 | sector = (GET_CL() & 0x3f);
|
---|
334 | head = GET_DH();
|
---|
335 |
|
---|
336 | /* Segment and offset are in ES:BX. */
|
---|
337 | if ( (count > 128) || (count == 0) ) {
|
---|
338 | BX_INFO("%s: function %02x, count out of range!\n", __func__, GET_AH());
|
---|
339 | goto int13_fail;
|
---|
340 | }
|
---|
341 |
|
---|
342 | /* Get the logical CHS geometry. */
|
---|
343 | nlc = bios_dsk->devices[device].lchs.cylinders;
|
---|
344 | nlh = bios_dsk->devices[device].lchs.heads;
|
---|
345 | nlspt = bios_dsk->devices[device].lchs.spt;
|
---|
346 |
|
---|
347 | /* Sanity check the geometry. */
|
---|
348 | if( (cylinder >= nlc) || (head >= nlh) || (sector > nlspt )) {
|
---|
349 | BX_INFO("%s: function %02x, disk %02x, parameters out of range %04x/%04x/%04x!\n", __func__, GET_AH(), GET_DL(), cylinder, head, sector);
|
---|
350 | goto int13_fail;
|
---|
351 | }
|
---|
352 |
|
---|
353 | // FIXME verify
|
---|
354 | if ( GET_AH() == 0x04 )
|
---|
355 | goto int13_success;
|
---|
356 |
|
---|
357 | /* If required, translate LCHS to LBA and execute command. */
|
---|
358 | /// @todo The IS_SCSI_DEVICE check should be redundant...
|
---|
359 | if (( (bios_dsk->devices[device].pchs.heads != nlh) || (bios_dsk->devices[device].pchs.spt != nlspt)) || VBOX_IS_SCSI_DEVICE(device)) {
|
---|
360 | lba = ((((uint32_t)cylinder * (uint32_t)nlh) + (uint32_t)head) * (uint32_t)nlspt) + (uint32_t)sector - 1;
|
---|
361 | sector = 0; // this forces the command to be lba
|
---|
362 | }
|
---|
363 |
|
---|
364 | BX_DEBUG_INT13_HD("%s: %d sectors from lba %lu @ %04x:%04x\n", __func__,
|
---|
365 | count, lba, ES, BX);
|
---|
366 |
|
---|
367 | /* Clear the count of transferred sectors/bytes. */
|
---|
368 | bios_dsk->drqp.trsfsectors = 0;
|
---|
369 | bios_dsk->drqp.trsfbytes = 0;
|
---|
370 |
|
---|
371 | /* Pass request information to low level disk code. */
|
---|
372 | bios_dsk->drqp.lba = lba;
|
---|
373 | bios_dsk->drqp.buffer = MK_FP(ES, BX);
|
---|
374 | bios_dsk->drqp.nsect = count;
|
---|
375 | bios_dsk->drqp.sect_sz = 512; /// @todo device specific?
|
---|
376 | bios_dsk->drqp.cylinder = cylinder;
|
---|
377 | bios_dsk->drqp.head = head;
|
---|
378 | bios_dsk->drqp.sector = sector;
|
---|
379 | bios_dsk->drqp.dev_id = device;
|
---|
380 |
|
---|
381 | status = dskacc[bios_dsk->devices[device].type].a[GET_AH() - 0x02](bios_dsk);
|
---|
382 |
|
---|
383 | // Set nb of sector transferred
|
---|
384 | SET_AL(bios_dsk->drqp.trsfsectors);
|
---|
385 |
|
---|
386 | if (status != 0) {
|
---|
387 | BX_INFO("%s: function %02x, error %02x !\n", __func__, GET_AH(), status);
|
---|
388 | SET_AH(0x0c);
|
---|
389 | goto int13_fail_noah;
|
---|
390 | }
|
---|
391 |
|
---|
392 | goto int13_success;
|
---|
393 | break;
|
---|
394 |
|
---|
395 | case 0x05: /* format disk track */
|
---|
396 | BX_INFO("format disk track called\n");
|
---|
397 | goto int13_success;
|
---|
398 | break;
|
---|
399 |
|
---|
400 | case 0x08: /* read disk drive parameters */
|
---|
401 |
|
---|
402 | /* Get the logical geometry from internal table. */
|
---|
403 | nlc = bios_dsk->devices[device].lchs.cylinders;
|
---|
404 | nlh = bios_dsk->devices[device].lchs.heads;
|
---|
405 | nlspt = bios_dsk->devices[device].lchs.spt;
|
---|
406 |
|
---|
407 | count = bios_dsk->hdcount;
|
---|
408 | /* Maximum cylinder number is just one less than the number of cylinders. */
|
---|
409 | nlc = nlc - 1; /* 0 based , last sector not used */
|
---|
410 | SET_AL(0);
|
---|
411 | SET_CH(nlc & 0xff);
|
---|
412 | SET_CL(((nlc >> 2) & 0xc0) | (nlspt & 0x3f));
|
---|
413 | SET_DH(nlh - 1);
|
---|
414 | SET_DL(count); /* FIXME returns 0, 1, or n hard drives */
|
---|
415 |
|
---|
416 | // FIXME should set ES & DI
|
---|
417 | /// @todo Actually, the above comment is nonsense.
|
---|
418 |
|
---|
419 | goto int13_success;
|
---|
420 | break;
|
---|
421 |
|
---|
422 | case 0x10: /* check drive ready */
|
---|
423 | // should look at 40:8E also???
|
---|
424 |
|
---|
425 | // Read the status from controller
|
---|
426 | status = inb(bios_dsk->channels[device/2].iobase1 + ATA_CB_STAT);
|
---|
427 | if ( (status & ( ATA_CB_STAT_BSY | ATA_CB_STAT_RDY )) == ATA_CB_STAT_RDY ) {
|
---|
428 | goto int13_success;
|
---|
429 | } else {
|
---|
430 | SET_AH(0xAA);
|
---|
431 | goto int13_fail_noah;
|
---|
432 | }
|
---|
433 | break;
|
---|
434 |
|
---|
435 | case 0x15: /* read disk drive size */
|
---|
436 |
|
---|
437 | /* Get the physical geometry from internal table. */
|
---|
438 | cylinder = bios_dsk->devices[device].pchs.cylinders;
|
---|
439 | head = bios_dsk->devices[device].pchs.heads;
|
---|
440 | sector = bios_dsk->devices[device].pchs.spt;
|
---|
441 |
|
---|
442 | /* Calculate sector count seen by old style INT 13h. */
|
---|
443 | lba = (uint32_t)cylinder * head * sector;
|
---|
444 | CX = lba >> 16;
|
---|
445 | DX = lba & 0xffff;
|
---|
446 |
|
---|
447 | SET_AH(3); // hard disk accessible
|
---|
448 | goto int13_success_noah;
|
---|
449 | break;
|
---|
450 |
|
---|
451 | case 0x09: /* initialize drive parameters */
|
---|
452 | case 0x0c: /* seek to specified cylinder */
|
---|
453 | case 0x0d: /* alternate disk reset */
|
---|
454 | case 0x11: /* recalibrate */
|
---|
455 | case 0x14: /* controller internal diagnostic */
|
---|
456 | BX_INFO("%s: function %02xh unimplemented, returns success\n", __func__, GET_AH());
|
---|
457 | goto int13_success;
|
---|
458 | break;
|
---|
459 |
|
---|
460 | case 0x0a: /* read disk sectors with ECC */
|
---|
461 | case 0x0b: /* write disk sectors with ECC */
|
---|
462 | case 0x18: // set media type for format
|
---|
463 | default:
|
---|
464 | BX_INFO("%s: function %02xh unsupported, returns fail\n", __func__, GET_AH());
|
---|
465 | goto int13_fail;
|
---|
466 | break;
|
---|
467 | }
|
---|
468 |
|
---|
469 | int13_fail:
|
---|
470 | SET_AH(0x01); // defaults to invalid function in AH or invalid parameter
|
---|
471 | int13_fail_noah:
|
---|
472 | SET_DISK_RET_STATUS(GET_AH());
|
---|
473 | int13_fail_nostatus:
|
---|
474 | SET_CF(); // error occurred
|
---|
475 | return;
|
---|
476 |
|
---|
477 | int13_success:
|
---|
478 | SET_AH(0x00); // no error
|
---|
479 | int13_success_noah:
|
---|
480 | SET_DISK_RET_STATUS(0x00);
|
---|
481 | CLEAR_CF(); // no error
|
---|
482 | return;
|
---|
483 | }
|
---|
484 |
|
---|
485 | void BIOSCALL int13_harddisk_ext(disk_regs_t r)
|
---|
486 | {
|
---|
487 | uint64_t lba;
|
---|
488 | uint16_t segment, offset;
|
---|
489 | uint8_t device, status;
|
---|
490 | uint16_t count;
|
---|
491 | uint8_t type;
|
---|
492 | bio_dsk_t __far *bios_dsk;
|
---|
493 | int13ext_t __far *i13_ext;
|
---|
494 | #if 0
|
---|
495 | uint16_t ebda_seg = read_word(0x0040,0x000E);
|
---|
496 | uint16_t npc, nph, npspt;
|
---|
497 | uint16_t size;
|
---|
498 | dpt_t __far *dpt;
|
---|
499 | #endif
|
---|
500 |
|
---|
501 | bios_dsk = read_word(0x0040,0x000E) :> &EbdaData->bdisk;
|
---|
502 |
|
---|
503 | BX_DEBUG_INT13_HD("%s: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x DS=%04x SI=%04x\n",
|
---|
504 | __func__, AX, BX, CX, DX, ES, DS, SI);
|
---|
505 |
|
---|
506 | write_byte(0x0040, 0x008e, 0); // clear completion flag
|
---|
507 |
|
---|
508 | // basic check : device has to be defined
|
---|
509 | if ( (GET_ELDL() < 0x80) || (GET_ELDL() >= 0x80 + BX_MAX_STORAGE_DEVICES) ) {
|
---|
510 | BX_DEBUG("%s: function %02x, ELDL out of range %02x\n", __func__, GET_AH(), GET_ELDL());
|
---|
511 | goto int13x_fail;
|
---|
512 | }
|
---|
513 |
|
---|
514 | // Get the ata channel
|
---|
515 | device = bios_dsk->hdidmap[GET_ELDL()-0x80];
|
---|
516 |
|
---|
517 | // basic check : device has to be valid
|
---|
518 | if (device >= BX_MAX_STORAGE_DEVICES) {
|
---|
519 | BX_DEBUG("%s: function %02x, unmapped device for ELDL=%02x\n", __func__, GET_AH(), GET_ELDL());
|
---|
520 | goto int13x_fail;
|
---|
521 | }
|
---|
522 |
|
---|
523 | switch (GET_AH()) {
|
---|
524 | case 0x41: // IBM/MS installation check
|
---|
525 | BX=0xaa55; // install check
|
---|
526 | SET_AH(0x30); // EDD 3.0
|
---|
527 | CX=0x0007; // ext disk access and edd, removable supported
|
---|
528 | goto int13x_success_noah;
|
---|
529 | break;
|
---|
530 |
|
---|
531 | case 0x42: // IBM/MS extended read
|
---|
532 | case 0x43: // IBM/MS extended write
|
---|
533 | case 0x44: // IBM/MS verify
|
---|
534 | case 0x47: // IBM/MS extended seek
|
---|
535 |
|
---|
536 | /* Get a pointer to the extended structure. */
|
---|
537 | i13_ext = DS :> (int13ext_t *)SI;
|
---|
538 |
|
---|
539 | count = i13_ext->count;
|
---|
540 | segment = i13_ext->segment;
|
---|
541 | offset = i13_ext->offset;
|
---|
542 |
|
---|
543 | // Get 64 bits lba and check
|
---|
544 | lba = i13_ext->lba2;
|
---|
545 | lba <<= 32;
|
---|
546 | lba |= i13_ext->lba1;
|
---|
547 |
|
---|
548 | BX_DEBUG_INT13_HD("%s: %d sectors from LBA 0x%llx @ %04x:%04x\n", __func__,
|
---|
549 | count, lba, segment, offset);
|
---|
550 |
|
---|
551 | type = bios_dsk->devices[device].type;
|
---|
552 | if (lba >= bios_dsk->devices[device].sectors) {
|
---|
553 | BX_INFO("%s: function %02x. LBA out of range\n", __func__, GET_AH());
|
---|
554 | goto int13x_fail;
|
---|
555 | }
|
---|
556 |
|
---|
557 | /* Don't bother with seek or verify. */
|
---|
558 | if (( GET_AH() == 0x44 ) || ( GET_AH() == 0x47 ))
|
---|
559 | goto int13x_success;
|
---|
560 |
|
---|
561 | /* Clear the count of transferred sectors/bytes. */
|
---|
562 | bios_dsk->drqp.trsfsectors = 0;
|
---|
563 | bios_dsk->drqp.trsfbytes = 0;
|
---|
564 |
|
---|
565 | /* Pass request information to low level disk code. */
|
---|
566 | bios_dsk->drqp.lba = lba;
|
---|
567 | bios_dsk->drqp.buffer = MK_FP(segment, offset);
|
---|
568 | bios_dsk->drqp.nsect = count;
|
---|
569 | bios_dsk->drqp.sect_sz = 512; /// @todo device specific?
|
---|
570 | bios_dsk->drqp.sector = 0; /* Indicate LBA. */
|
---|
571 | bios_dsk->drqp.dev_id = device;
|
---|
572 |
|
---|
573 | /* Execute the read or write command. */
|
---|
574 | status = dskacc[type].a[GET_AH() - 0x42](bios_dsk);
|
---|
575 | count = bios_dsk->drqp.trsfsectors;
|
---|
576 | i13_ext->count = count;
|
---|
577 |
|
---|
578 | if (status != 0) {
|
---|
579 | BX_INFO("%s: function %02x, error %02x !\n", __func__, GET_AH(), status);
|
---|
580 | SET_AH(0x0c);
|
---|
581 | goto int13x_fail_noah;
|
---|
582 | }
|
---|
583 |
|
---|
584 | goto int13x_success;
|
---|
585 | break;
|
---|
586 |
|
---|
587 | case 0x45: // IBM/MS lock/unlock drive
|
---|
588 | case 0x49: // IBM/MS extended media change
|
---|
589 | goto int13x_success; // Always success for HD
|
---|
590 | break;
|
---|
591 |
|
---|
592 | case 0x46: // IBM/MS eject media
|
---|
593 | SET_AH(0xb2); // Volume Not Removable
|
---|
594 | goto int13x_fail_noah; // Always fail for HD
|
---|
595 | break;
|
---|
596 |
|
---|
597 | case 0x48: // IBM/MS get drive parameters
|
---|
598 | if (edd_fill_dpt(DS :> (dpt_t *)SI, bios_dsk, device))
|
---|
599 | goto int13x_fail;
|
---|
600 | else
|
---|
601 | goto int13x_success;
|
---|
602 | break;
|
---|
603 |
|
---|
604 | case 0x4e: // // IBM/MS set hardware configuration
|
---|
605 | // DMA, prefetch, PIO maximum not supported
|
---|
606 | switch (GET_AL()) {
|
---|
607 | case 0x01:
|
---|
608 | case 0x03:
|
---|
609 | case 0x04:
|
---|
610 | case 0x06:
|
---|
611 | goto int13x_success;
|
---|
612 | break;
|
---|
613 | default :
|
---|
614 | goto int13x_fail;
|
---|
615 | }
|
---|
616 | break;
|
---|
617 |
|
---|
618 | case 0x50: // IBM/MS send packet command
|
---|
619 | default:
|
---|
620 | BX_INFO("%s: function %02xh unsupported, returns fail\n", __func__, GET_AH());
|
---|
621 | goto int13x_fail;
|
---|
622 | break;
|
---|
623 | }
|
---|
624 |
|
---|
625 | int13x_fail:
|
---|
626 | SET_AH(0x01); // defaults to invalid function in AH or invalid parameter
|
---|
627 | int13x_fail_noah:
|
---|
628 | SET_DISK_RET_STATUS(GET_AH());
|
---|
629 | SET_CF(); // error occurred
|
---|
630 | return;
|
---|
631 |
|
---|
632 | int13x_success:
|
---|
633 | SET_AH(0x00); // no error
|
---|
634 | int13x_success_noah:
|
---|
635 | SET_DISK_RET_STATUS(0x00);
|
---|
636 | CLEAR_CF(); // no error
|
---|
637 | return;
|
---|
638 | }
|
---|
639 |
|
---|
640 | /* Avoid saving general registers already saved by caller (PUSHA). */
|
---|
641 | #pragma aux int13_harddisk modify [di si cx dx bx];
|
---|
642 | #pragma aux int13_harddisk_ext modify [di si cx dx bx];
|
---|
643 |
|
---|