1 | /*
|
---|
2 | * Copyright (C) 2006-2016 Oracle Corporation
|
---|
3 | *
|
---|
4 | * This file is part of VirtualBox Open Source Edition (OSE), as
|
---|
5 | * available from http://www.virtualbox.org. This file is free software;
|
---|
6 | * you can redistribute it and/or modify it under the terms of the GNU
|
---|
7 | * General Public License (GPL) as published by the Free Software
|
---|
8 | * Foundation, in version 2 as it comes in the "COPYING" file of the
|
---|
9 | * VirtualBox OSE distribution. VirtualBox OSE is distributed in the
|
---|
10 | * hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
|
---|
11 | * --------------------------------------------------------------------
|
---|
12 | *
|
---|
13 | * This code is based on:
|
---|
14 | *
|
---|
15 | * ROM BIOS for use with Bochs/Plex86/QEMU emulation environment
|
---|
16 | *
|
---|
17 | * Copyright (C) 2002 MandrakeSoft S.A.
|
---|
18 | *
|
---|
19 | * MandrakeSoft S.A.
|
---|
20 | * 43, rue d'Aboukir
|
---|
21 | * 75002 Paris - France
|
---|
22 | * http://www.linux-mandrake.com/
|
---|
23 | * http://www.mandrakesoft.com/
|
---|
24 | *
|
---|
25 | * This library is free software; you can redistribute it and/or
|
---|
26 | * modify it under the terms of the GNU Lesser General Public
|
---|
27 | * License as published by the Free Software Foundation; either
|
---|
28 | * version 2 of the License, or (at your option) any later version.
|
---|
29 | *
|
---|
30 | * This library is distributed in the hope that it will be useful,
|
---|
31 | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
32 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
---|
33 | * Lesser General Public License for more details.
|
---|
34 | *
|
---|
35 | * You should have received a copy of the GNU Lesser General Public
|
---|
36 | * License along with this library; if not, write to the Free Software
|
---|
37 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
---|
38 | *
|
---|
39 | */
|
---|
40 |
|
---|
41 |
|
---|
42 | #include <stdint.h>
|
---|
43 | #include "biosint.h"
|
---|
44 | #include "inlines.h"
|
---|
45 |
|
---|
46 | void BIOSCALL int17_function(pusha_regs_t regs, uint16_t es, uint16_t ds, volatile iret_addr_t iret_addr)
|
---|
47 | {
|
---|
48 | uint16_t addr,timeout;
|
---|
49 | uint8_t val8;
|
---|
50 |
|
---|
51 | int_enable();
|
---|
52 |
|
---|
53 | addr = read_word(0x0040, (regs.u.r16.dx << 1) + 8);
|
---|
54 | if ((regs.u.r8.ah < 3) && (regs.u.r16.dx < 3) && (addr > 0)) {
|
---|
55 | timeout = read_byte(0x0040, 0x0078 + regs.u.r16.dx) << 8;
|
---|
56 | if (regs.u.r8.ah == 0) {
|
---|
57 | outb(addr, regs.u.r8.al);
|
---|
58 | val8 = inb(addr+2);
|
---|
59 | outb(addr+2, val8 | 0x01); // send strobe
|
---|
60 | outb(addr+2, val8 & ~0x01);
|
---|
61 | while (((inb(addr+1) & 0x40) == 0x40) && (timeout)) {
|
---|
62 | timeout--;
|
---|
63 | }
|
---|
64 | }
|
---|
65 | if (regs.u.r8.ah == 1) {
|
---|
66 | val8 = inb(addr+2);
|
---|
67 | outb(addr+2, val8 & ~0x04); // send init
|
---|
68 | outb(addr+2, val8 | 0x04);
|
---|
69 | }
|
---|
70 | val8 = inb(addr+1);
|
---|
71 | regs.u.r8.ah = (val8 ^ 0x48);
|
---|
72 | if (!timeout) regs.u.r8.ah |= 0x01;
|
---|
73 | ClearCF(iret_addr.flags);
|
---|
74 | } else {
|
---|
75 | SetCF(iret_addr.flags); // Unsupported
|
---|
76 | }
|
---|
77 | }
|
---|