summaryrefslogtreecommitdiff
path: root/util/ADLO/bochs
diff options
context:
space:
mode:
authorStefan Reinauer <stepan@coresystems.de>2009-10-30 20:38:15 +0000
committerStefan Reinauer <stepan@openbios.org>2009-10-30 20:38:15 +0000
commit3f3a5f60d3e2d2470ce3099874f753ae7107b3f2 (patch)
tree237686b98821cb42fa22aefe244d9b50f35b9eed /util/ADLO/bochs
parent20d626572bf95cd20bfeec98e81a74a2b40366b8 (diff)
ADLO has long been replaced by SeaBIOS, and it's also in v1 if someone needs
it... Signed-off-by: Stefan Reinauer <stepan@coresystems.de> Acked-by: Patrick Georgi <patrick.georgi@coresystems.de> git-svn-id: svn://svn.coreboot.org/coreboot/trunk@4900 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
Diffstat (limited to 'util/ADLO/bochs')
-rw-r--r--util/ADLO/bochs/bios/Makefile50
-rw-r--r--util/ADLO/bochs/bios/README1
-rw-r--r--util/ADLO/bochs/bios/rombios.c10551
3 files changed, 0 insertions, 10602 deletions
diff --git a/util/ADLO/bochs/bios/Makefile b/util/ADLO/bochs/bios/Makefile
deleted file mode 100644
index 49b702b3f3..0000000000
--- a/util/ADLO/bochs/bios/Makefile
+++ /dev/null
@@ -1,50 +0,0 @@
-# Copyright (C) 2001 MandrakeSoft S.A.
-#
-# MandrakeSoft S.A.
-# 43, rue d'Aboukir
-# 75002 Paris - France
-# http://www.linux-mandrake.com/
-# http://www.mandrakesoft.com/
-#
-# This library is free software; you can redistribute it and/or
-# modify it under the terms of the GNU Lesser General Public
-# License as published by the Free Software Foundation; either
-# version 2 of the License, or (at your option) any later version.
-#
-# This library is distributed in the hope that it will be useful,
-# but WITHOUT ANY WARRANTY; without even the implied warranty of
-# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
-# Lesser General Public License for more details.
-#
-# You should have received a copy of the GNU Lesser General Public
-# License along with this library; if not, write to the Free Software
-# Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
-
-# Makefile for the BIOS component of bochs
-
-.SUFFIXES: .cc
-
-# -------- end configurable options --------------------------
-
-.cc.o:
- $(CXX) -c $(CXXFLAGS) $(LOCAL_CXXFLAGS) $(BX_INCDIRS) $< -o $@
-
-bios: rombios.bin
-
-rombios.bin: rombios.c
- gcc -E -P $< > _rombios_.c
- bcc -o rombios.s -C-c -D__i86__ -0 -S _rombios_.c
- sed -e 's/^\.text//' -e 's/^\.data//' rombios.s > _rombios_.s
- as86 _rombios_.s -b rombios.bin -u- -w- -g -0 -j -O -l rombios.txt
- ls -l rombios.bin
-
-# -----------------------------------------------------------------
-
-clean:
- rm -f *.s
- rm -f _rombios_.c
- rm -f rombios.txt
- rm -f rombios.bin
-
-
-# -----------------------------------------------------------------
diff --git a/util/ADLO/bochs/bios/README b/util/ADLO/bochs/bios/README
deleted file mode 100644
index b6b9549823..0000000000
--- a/util/ADLO/bochs/bios/README
+++ /dev/null
@@ -1 +0,0 @@
-The bochs bios.
diff --git a/util/ADLO/bochs/bios/rombios.c b/util/ADLO/bochs/bios/rombios.c
deleted file mode 100644
index 204300e3ea..0000000000
--- a/util/ADLO/bochs/bios/rombios.c
+++ /dev/null
@@ -1,10551 +0,0 @@
-/////////////////////////////////////////////////////////////////////////
-// $Id: rombios.c,v 1.163 2006/07/07 16:10:37 vruppert Exp $
-/////////////////////////////////////////////////////////////////////////
-//
-// Copyright (C) 2002 MandrakeSoft S.A.
-//
-// MandrakeSoft S.A.
-// 43, rue d'Aboukir
-// 75002 Paris - France
-// http://www.linux-mandrake.com/
-// http://www.mandrakesoft.com/
-//
-// This library is free software; you can redistribute it and/or
-// modify it under the terms of the GNU Lesser General Public
-// License as published by the Free Software Foundation; either
-// version 2 of the License, or (at your option) any later version.
-//
-// This library is distributed in the hope that it will be useful,
-// but WITHOUT ANY WARRANTY; without even the implied warranty of
-// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
-// Lesser General Public License for more details.
-//
-// You should have received a copy of the GNU Lesser General Public
-// License along with this library; if not, write to the Free Software
-// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
-
-// ROM BIOS for use with Bochs/Plex x86 emulation environment
-
-
-// ROM BIOS compatability entry points:
-// ===================================
-// $e05b ; POST Entry Point
-// $e2c3 ; NMI Handler Entry Point
-// $e3fe ; INT 13h Fixed Disk Services Entry Point
-// $e401 ; Fixed Disk Parameter Table
-// $e6f2 ; INT 19h Boot Load Service Entry Point
-// $e6f5 ; Configuration Data Table
-// $e729 ; Baud Rate Generator Table
-// $e739 ; INT 14h Serial Communications Service Entry Point
-// $e82e ; INT 16h Keyboard Service Entry Point
-// $e987 ; INT 09h Keyboard Service Entry Point
-// $ec59 ; INT 13h Diskette Service Entry Point
-// $ef57 ; INT 0Eh Diskette Hardware ISR Entry Point
-// $efc7 ; Diskette Controller Parameter Table
-// $efd2 ; INT 17h Printer Service Entry Point
-// $f045 ; INT 10 Functions 0-Fh Entry Point
-// $f065 ; INT 10h Video Support Service Entry Point
-// $f0a4 ; MDA/CGA Video Parameter Table (INT 1Dh)
-// $f841 ; INT 12h Memory Size Service Entry Point
-// $f84d ; INT 11h Equipment List Service Entry Point
-// $f859 ; INT 15h System Services Entry Point
-// $fa6e ; Character Font for 320x200 & 640x200 Graphics (lower 128 characters)
-// $fe6e ; INT 1Ah Time-of-day Service Entry Point
-// $fea5 ; INT 08h System Timer ISR Entry Point
-// $fef3 ; Initial Interrupt Vector Offsets Loaded by POST
-// $ff53 ; IRET Instruction for Dummy Interrupt Handler
-// $ff54 ; INT 05h Print Screen Service Entry Point
-// $fff0 ; Power-up Entry Point
-// $fff5 ; ASCII Date ROM was built - 8 characters in MM/DD/YY
-// $fffe ; System Model ID
-
-// NOTES for ATA/ATAPI driver (cbbochs@free.fr)
-// Features
-// - supports up to 4 ATA interfaces
-// - device/geometry detection
-// - 16bits/32bits device access
-// - pchs/lba access
-// - datain/dataout/packet command support
-//
-// NOTES for El-Torito Boot (cbbochs@free.fr)
-// - CD-ROM booting is only available if ATA/ATAPI Driver is available
-// - Current code is only able to boot mono-session cds
-// - Current code can not boot and emulate a hard-disk
-// the bios will panic otherwise
-// - Current code also use memory in EBDA segement.
-// - I used cmos byte 0x3D to store extended information on boot-device
-// - Code has to be modified modified to handle multiple cdrom drives
-// - Here are the cdrom boot failure codes:
-// 1 : no atapi device found
-// 2 : no atapi cdrom found
-// 3 : can not read cd - BRVD
-// 4 : cd is not eltorito (BRVD)
-// 5 : cd is not eltorito (ISO TAG)
-// 6 : cd is not eltorito (ELTORITO TAG)
-// 7 : can not read cd - boot catalog
-// 8 : boot catalog : bad header
-// 9 : boot catalog : bad platform
-// 10 : boot catalog : bad signature
-// 11 : boot catalog : bootable flag not set
-// 12 : can not read cd - boot image
-//
-// ATA driver
-// - EBDA segment.
-// I used memory starting at 0x121 in the segment
-// - the translation policy is defined in cmos regs 0x39 & 0x3a
-//
-// TODO :
-//
-// int74
-// - needs to be reworked. Uses direct [bp] offsets. (?)
-//
-// int13:
-// - f04 (verify sectors) isn't complete (?)
-// - f02/03/04 should set current cyl,etc in BDA (?)
-// - rewrite int13_relocated & clean up int13 entry code
-//
-// NOTES:
-// - NMI access (bit7 of addr written to 70h)
-//
-// ATA driver
-// - should handle the "don't detect" bit (cmos regs 0x3b & 0x3c)
-// - could send the multiple-sector read/write commands
-//
-// El-Torito
-// - Emulate a Hard-disk (currently only diskette can be emulated) see "FIXME ElTorito Harddisk"
-// - Implement remaining int13_cdemu functions (as defined by El-Torito specs)
-// - cdrom drive is hardcoded to ide 0 device 1 in several places. see "FIXME ElTorito Hardcoded"
-// - int13 Fix DL when emulating a cd. In that case DL is decremented before calling real int13.
-// This is ok. But DL should be reincremented afterwards.
-// - Fix all "FIXME ElTorito Various"
-// - should be able to boot any cdrom instead of the first one
-//
-// BCC Bug: find a generic way to handle the bug of #asm after an "if" (fixed in 0.16.7)
-
-#define DEBUG_ROMBIOS 1
-
-#define DEBUG_ATA 0
-#define DEBUG_INT13_HD 0
-#define DEBUG_INT13_CD 0
-#define DEBUG_INT13_ET 0
-#define DEBUG_INT13_FL 0
-#define DEBUG_INT15 0
-#define DEBUG_INT16 0
-#define DEBUG_INT1A 0
-#define DEBUG_INT74 0
-#define DEBUG_APM 0
-
-#define BX_CPU 3
-#define BX_USE_PS2_MOUSE 1
-#define BX_CALL_INT15_4F 1
-#define BX_USE_EBDA 1
-#define BX_SUPPORT_FLOPPY 1
-#define BX_FLOPPY_ON_CNT 37 /* 2 seconds */
-//#define BX_PCIBIOS 1
-#define BX_APM 0
-
-#define COREBOOT 1
-
-#define BX_USE_ATADRV 1
-//#define BX_ELTORITO_BOOT 1
-
-#define BX_MAX_ATA_INTERFACES 4
-#define BX_MAX_ATA_DEVICES (BX_MAX_ATA_INTERFACES*2)
-
-#define BX_VIRTUAL_PORTS 1 /* normal output to Bochs ports */
-#define BX_DEBUG_SERIAL 1 /* output to COM1 */
-
- /* model byte 0xFC = AT */
-#define SYS_MODEL_ID 0xFC
-#define SYS_SUBMODEL_ID 0x00
-#define BIOS_REVISION 1
-#define BIOS_CONFIG_TABLE 0xe6f5
-
-#ifndef BIOS_BUILD_DATE
-# define BIOS_BUILD_DATE "06/23/99"
-#endif
-
- // 1K of base memory used for Extended Bios Data Area (EBDA)
- // EBDA is used for PS/2 mouse support, and IDE BIOS, etc.
-#define EBDA_SEG 0x9FC0
-#define EBDA_SIZE 1 // In KiB
-#define BASE_MEM_IN_K (640 - EBDA_SIZE)
-
- // Define the application NAME
-#ifdef PLEX86
-# define BX_APPNAME "Plex86"
-#else
-# define BX_APPNAME "Bochs"
-#endif
-
- // Sanity Checks
-#if BX_USE_ATADRV && BX_CPU<3
-# error The ATA/ATAPI Driver can only to be used with a 386+ cpu
-#endif
-#if BX_USE_ATADRV && !BX_USE_EBDA
-# error ATA/ATAPI Driver can only be used if EBDA is available
-#endif
-#if BX_ELTORITO_BOOT && !BX_USE_ATADRV
-# error El-Torito Boot can only be use if ATA/ATAPI Driver is available
-#endif
-#if BX_PCIBIOS && BX_CPU<3
-# error PCI BIOS can only be used with 386+ cpu
-#endif
-#if BX_APM && BX_CPU<3
-# error APM BIOS can only be used with 386+ cpu
-#endif
-
-#define PANIC_PORT 0x400
-#define PANIC_PORT2 0x401
-#define INFO_PORT 0x402
-#define DEBUG_PORT 0x403
-
-// define this if you want to make PCIBIOS working on a specific bridge only
-// undef enables PCIBIOS when at least one PCI device is found
-// i440FX is emulated by Bochs and QEMU
-#define PCI_FIXED_HOST_BRIDGE 0x12378086 ;; i440FX PCI bridge
-
-// #20 is dec 20
-// #$20 is hex 20 = 32
-// #0x20 is hex 20 = 32
-// LDA #$20
-// JSR $E820
-// LDD .i,S
-// JSR $C682
-// mov al, #$20
-
-// all hex literals should be prefixed with '0x'
-// grep "#[0-9a-fA-F][0-9a-fA-F]" rombios.c
-// no mov SEG-REG, #value, must mov register into seg-reg
-// grep -i "mov[ ]*.s" rombios.c
-
-// This is for compiling with gcc2 and gcc3
-#define ASM_START #asm
-#define ASM_END #endasm
-
-ASM_START
-.rom
-
-.org 0x0000
-
-#if BX_CPU >= 3
-use16 386
-#else
-use16 286
-#endif
-
-MACRO HALT
- ;; the HALT macro is called with the line number of the HALT call.
- ;; The line number is then sent to the PANIC_PORT, causing Bochs/Plex
- ;; to print a BX_PANIC message. This will normally halt the simulation
- ;; with a message such as "BIOS panic at rombios.c, line 4091".
- ;; However, users can choose to make panics non-fatal and continue.
-#if BX_VIRTUAL_PORTS
- mov dx,#PANIC_PORT
- mov ax,#?1
- out dx,ax
-#else
- mov dx,#0x80
- mov ax,#?1
- out dx,al
-#endif
-MEND
-
-MACRO JMP_AP
- db 0xea
- dw ?2
- dw ?1
-MEND
-
-MACRO SET_INT_VECTOR
- mov ax, ?3
- mov ?1*4, ax
- mov ax, ?2
- mov ?1*4+2, ax
-MEND
-
-ASM_END
-
-typedef unsigned char Bit8u;
-typedef unsigned short Bit16u;
-typedef unsigned short bx_bool;
-typedef unsigned long Bit32u;
-
-#if BX_USE_ATADRV
-
- void memsetb(seg,offset,value,count);
- void memcpyb(dseg,doffset,sseg,soffset,count);
- void memcpyd(dseg,doffset,sseg,soffset,count);
-
- // memset of count bytes
- void
- memsetb(seg,offset,value,count)
- Bit16u seg;
- Bit16u offset;
- Bit16u value;
- Bit16u count;
- {
- ASM_START
- push bp
- mov bp, sp
-
- push ax
- push cx
- push es
- push di
-
- mov cx, 10[bp] ; count
- cmp cx, #0x00
- je memsetb_end
- mov ax, 4[bp] ; segment
- mov es, ax
- mov ax, 6[bp] ; offset
- mov di, ax
- mov al, 8[bp] ; value
- cld
- rep
- stosb
-
- memsetb_end:
- pop di
- pop es
- pop cx
- pop ax
-
- pop bp
- ASM_END
- }
-
-#if 0
- // memcpy of count bytes
- void
- memcpyb(dseg,doffset,sseg,soffset,count)
- Bit16u dseg;
- Bit16u doffset;
- Bit16u sseg;
- Bit16u soffset;
- Bit16u count;
- {
- ASM_START
- push bp
- mov bp, sp
-
- push ax
- push cx
- push es
- push di
- push ds
- push si
-
- mov cx, 12[bp] ; count
- cmp cx, #0x0000
- je memcpyb_end
- mov ax, 4[bp] ; dsegment
- mov es, ax
- mov ax, 6[bp] ; doffset
- mov di, ax
- mov ax, 8[bp] ; ssegment
- mov ds, ax
- mov ax, 10[bp] ; soffset
- mov si, ax
- cld
- rep
- movsb
-
- memcpyb_end:
- pop si
- pop ds
- pop di
- pop es
- pop cx
- pop ax
-
- pop bp
- ASM_END
- }
-
- // memcpy of count dword
- void
- memcpyd(dseg,doffset,sseg,soffset,count)
- Bit16u dseg;
- Bit16u doffset;
- Bit16u sseg;
- Bit16u soffset;
- Bit16u count;
- {
- ASM_START
- push bp
- mov bp, sp
-
- push ax
- push cx
- push es
- push di
- push ds
- push si
-
- mov cx, 12[bp] ; count
- cmp cx, #0x0000
- je memcpyd_end
- mov ax, 4[bp] ; dsegment
- mov es, ax
- mov ax, 6[bp] ; doffset
- mov di, ax
- mov ax, 8[bp] ; ssegment
- mov ds, ax
- mov ax, 10[bp] ; soffset
- mov si, ax
- cld
- rep
- movsd
-
- memcpyd_end:
- pop si
- pop ds
- pop di
- pop es
- pop cx
- pop ax
-
- pop bp
- ASM_END
- }
-#endif
-#endif //BX_USE_ATADRV
-
- // read_dword and write_dword functions
- static Bit32u read_dword();
- static void write_dword();
-
- Bit32u
- read_dword(seg, offset)
- Bit16u seg;
- Bit16u offset;
- {
- ASM_START
- push bp
- mov bp, sp
-
- push bx
- push ds
- mov ax, 4[bp] ; segment
- mov ds, ax
- mov bx, 6[bp] ; offset
- mov ax, [bx]
- inc bx
- inc bx
- mov dx, [bx]
- ;; ax = return value (word)
- ;; dx = return value (word)
- pop ds
- pop bx
-
- pop bp
- ASM_END
- }
-
- void
- write_dword(seg, offset, data)
- Bit16u seg;
- Bit16u offset;
- Bit32u data;
- {
- ASM_START
- push bp
- mov bp, sp
-
- push ax
- push bx
- push ds
- mov ax, 4[bp] ; segment
- mov ds, ax
- mov bx, 6[bp] ; offset
- mov ax, 8[bp] ; data word
- mov [bx], ax ; write data word
- inc bx
- inc bx
- mov ax, 10[bp] ; data word
- mov [bx], ax ; write data word
- pop ds
- pop bx
- pop ax
-
- pop bp
- ASM_END
- }
-
- // Bit32u (unsigned long) and long helper functions
- ASM_START
-
- ;; and function
- landl:
- landul:
- SEG SS
- and ax,[di]
- SEG SS
- and bx,2[di]
- ret
-
- ;; add function
- laddl:
- laddul:
- SEG SS
- add ax,[di]
- SEG SS
- adc bx,2[di]
- ret
-
- ;; cmp function
- lcmpl:
- lcmpul:
- and eax, #0x0000FFFF
- shl ebx, #16
- add eax, ebx
- shr ebx, #16
- SEG SS
- cmp eax, dword ptr [di]
- ret
-
- ;; sub function
- lsubl:
- lsubul:
- SEG SS
- sub ax,[di]
- SEG SS
- sbb bx,2[di]
- ret
-
- ;; mul function
- lmull:
- lmulul:
- and eax, #0x0000FFFF
- shl ebx, #16
- add eax, ebx
- SEG SS
- mul eax, dword ptr [di]
- mov ebx, eax
- shr ebx, #16
- ret
-
- ;; dec function
- ldecl:
- ldecul:
- SEG SS
- dec dword ptr [bx]
- ret
-
- ;; or function
- lorl:
- lorul:
- SEG SS
- or ax,[di]
- SEG SS
- or bx,2[di]
- ret
-
- ;; inc function
- lincl:
- lincul:
- SEG SS
- inc dword ptr [bx]
- ret
-
- ;; tst function
- ltstl:
- ltstul:
- and eax, #0x0000FFFF
- shl ebx, #16
- add eax, ebx
- shr ebx, #16
- test eax, eax
- ret
-
- ;; sr function
- lsrul:
- mov cx,di
- jcxz lsr_exit
- and eax, #0x0000FFFF
- shl ebx, #16
- add eax, ebx
- lsr_loop:
- shr eax, #1
- loop lsr_loop
- mov ebx, eax
- shr ebx, #16
- lsr_exit:
- ret
-
- ;; sl function
- lsll:
- lslul:
- mov cx,di
- jcxz lsl_exit
- and eax, #0x0000FFFF
- shl ebx, #16
- add eax, ebx
- lsl_loop:
- shl eax, #1
- loop lsl_loop
- mov ebx, eax
- shr ebx, #16
- lsl_exit:
- ret
-
- idiv_:
- cwd
- idiv bx
- ret
-
- idiv_u:
- xor dx,dx
- div bx
- ret
-
- ldivul:
- and eax, #0x0000FFFF
- shl ebx, #16
- add eax, ebx
- xor edx, edx
- SEG SS
- mov bx, 2[di]
- shl ebx, #16
- SEG SS
- mov bx, [di]
- div ebx
- mov ebx, eax
- shr ebx, #16
- ret
-
- ASM_END
-
-// for access to RAM area which is used by interrupt vectors
-// and BIOS Data Area
-
-typedef struct {
- unsigned char filler1[0x400];
- unsigned char filler2[0x6c];
- Bit16u ticks_low;
- Bit16u ticks_high;
- Bit8u midnight_flag;
- } bios_data_t;
-
-#define BiosData ((bios_data_t *) 0)
-
-#if BX_USE_ATADRV
- typedef struct {
- Bit16u heads; // # heads
- Bit16u cylinders; // # cylinders
- Bit16u spt; // # sectors / track
- } chs_t;
-
- // DPTE definition
- typedef struct {
- Bit16u iobase1;
- Bit16u iobase2;
- Bit8u prefix;
- Bit8u unused;
- Bit8u irq;
- Bit8u blkcount;
- Bit8u dma;
- Bit8u pio;
- Bit16u options;
- Bit16u reserved;
- Bit8u revision;
- Bit8u checksum;
- } dpte_t;
-
- typedef struct {
- Bit8u iface; // ISA or PCI
- Bit16u iobase1; // IO Base 1
- Bit16u iobase2; // IO Base 2
- Bit8u irq; // IRQ
- } ata_channel_t;
-
- typedef struct {
- Bit8u type; // Detected type of ata (ata/atapi/none/unknown)
- Bit8u device; // Detected type of attached devices (hd/cd/none)
- Bit8u removable; // Removable device flag
- Bit8u lock; // Locks for removable devices
- // Bit8u lba_capable; // LBA capable flag - always yes for bochs devices
- Bit8u mode; // transfert mode : PIO 16/32 bits - IRQ - ISADMA - PCIDMA
- Bit16u blksize; // block size
-
- Bit8u translation; // type of translation
- chs_t lchs; // Logical CHS
- chs_t pchs; // Physical CHS
-
- Bit32u sectors; // Total sectors count
- } ata_device_t;
-
- typedef struct {
- // ATA channels info
- ata_channel_t channels[BX_MAX_ATA_INTERFACES];
-
- // ATA devices info
- ata_device_t devices[BX_MAX_ATA_DEVICES];
- //
- // map between (bios hd id - 0x80) and ata channels
- Bit8u hdcount, hdidmap[BX_MAX_ATA_DEVICES];
-
- // map between (bios cd id - 0xE0) and ata channels
- Bit8u cdcount, cdidmap[BX_MAX_ATA_DEVICES];
-
- // Buffer for DPTE table
- dpte_t dpte;
-
- // Count of transferred sectors and bytes
- Bit16u trsfsectors;
- Bit32u trsfbytes;
-
- } ata_t;
-
-#if BX_ELTORITO_BOOT
- // ElTorito Device Emulation data
- typedef struct {
- Bit8u active;
- Bit8u media;
- Bit8u emulated_drive;
- Bit8u controller_index;
- Bit16u device_spec;
- Bit32u ilba;
- Bit16u buffer_segment;
- Bit16u load_segment;
- Bit16u sector_count;
-
- // Virtual device
- chs_t vdevice;
- } cdemu_t;
-#endif // BX_ELTORITO_BOOT
-
- // for access to EBDA area
- // The EBDA structure should conform to
- // http://www.frontiernet.net/~fys/rombios.htm document
- // I made the ata and cdemu structs begin at 0x121 in the EBDA seg
- typedef struct {
- unsigned char filler1[0x3D];
-
- // FDPT - Can be splitted in data members if needed
- unsigned char fdpt0[0x10];
- unsigned char fdpt1[0x10];
-
- unsigned char filler2[0xC4];
-
- // ATA Driver data
- ata_t ata;
-
-#if BX_ELTORITO_BOOT
- // El Torito Emulation data
- cdemu_t cdemu;
-#endif // BX_ELTORITO_BOOT
-
- } ebda_data_t;
-
- #define EbdaData ((ebda_data_t *) 0)
-
- // for access to the int13ext structure
- typedef struct {
- Bit8u size;
- Bit8u reserved;
- Bit16u count;
- Bit16u offset;
- Bit16u segment;
- Bit32u lba1;
- Bit32u lba2;
- } int13ext_t;
-
- #define Int13Ext ((int13ext_t *) 0)
-
- // Disk Physical Table definition
- typedef struct {
- Bit16u size;
- Bit16u infos;
- Bit32u cylinders;
- Bit32u heads;
- Bit32u spt;
- Bit32u sector_count1;
- Bit32u sector_count2;
- Bit16u blksize;
- Bit16u dpte_segment;
- Bit16u dpte_offset;
- Bit16u key;
- Bit8u dpi_length;
- Bit8u reserved1;
- Bit16u reserved2;
- Bit8u host_bus[4];
- Bit8u iface_type[8];
- Bit8u iface_path[8];
- Bit8u device_path[8];
- Bit8u reserved3;
- Bit8u checksum;
- } dpt_t;
-
- #define Int13DPT ((dpt_t *) 0)
-
-#endif // BX_USE_ATADRV
-
-typedef struct {
- union {
- struct {
- Bit16u di, si, bp, sp;
- Bit16u bx, dx, cx, ax;
- } r16;
- struct {
- Bit16u filler[4];
- Bit8u bl, bh, dl, dh, cl, ch, al, ah;
- } r8;
- } u;
- } pusha_regs_t;
-
-typedef struct {
- union {
- struct {
- Bit32u edi, esi, ebp, esp;
- Bit32u ebx, edx, ecx, eax;
- } r32;
- struct {
- Bit16u di, filler1, si, filler2, bp, filler3, sp, filler4;
- Bit16u bx, filler5, dx, filler6, cx, filler7, ax, filler8;
- } r16;
- struct {
- Bit32u filler[4];
- Bit8u bl, bh;
- Bit16u filler1;
- Bit8u dl, dh;
- Bit16u filler2;
- Bit8u cl, ch;
- Bit16u filler3;
- Bit8u al, ah;
- Bit16u filler4;
- } r8;
- } u;
-} pushad_regs_t;
-
-typedef struct {
- union {
- struct {
- Bit16u flags;
- } r16;
- struct {
- Bit8u flagsl;
- Bit8u flagsh;
- } r8;
- } u;
- } flags_t;
-
-#define SetCF(x) x.u.r8.flagsl |= 0x01
-#define SetZF(x) x.u.r8.flagsl |= 0x40
-#define ClearCF(x) x.u.r8.flagsl &= 0xfe
-#define ClearZF(x) x.u.r8.flagsl &= 0xbf
-#define GetCF(x) (x.u.r8.flagsl & 0x01)
-
-typedef struct {
- Bit16u ip;
- Bit16u cs;
- flags_t flags;
- } iret_addr_t;
-
-
-
-static Bit8u inb();
-static Bit8u inb_cmos();
-static void outb();
-static void outb_cmos();
-static Bit16u inw();
-static void outw();
-static void init_rtc();
-static bx_bool rtc_updating();
-
-static Bit8u read_byte();
-static Bit16u read_word();
-static void write_byte();
-static void write_word();
-static void bios_printf();
-
-static Bit8u inhibit_mouse_int_and_events();
-static void enable_mouse_int_and_events();
-static Bit8u send_to_mouse_ctrl();
-static Bit8u get_mouse_data();
-static void set_kbd_command_byte();
-
-static void int09_function();
-static void int13_harddisk();
-static void int13_cdrom();
-static void int13_cdemu();
-static void int13_eltorito();
-static void int13_diskette_function();
-static void int14_function();
-static void int15_function();
-static void int16_function();
-static void int17_function();
-static Bit32u int19_function();
-static void int1a_function();
-static void int70_function();
-static void int74_function();
-static Bit16u get_CS();
-static Bit16u get_SS();
-static unsigned int enqueue_key();
-static unsigned int dequeue_key();
-static void get_hd_geometry();
-static void set_diskette_ret_status();
-static void set_diskette_current_cyl();
-static void determine_floppy_media();
-static bx_bool floppy_drive_exists();
-static bx_bool floppy_drive_recal();
-static bx_bool floppy_media_known();
-static bx_bool floppy_media_sense();
-static bx_bool set_enable_a20();
-static void debugger_on();
-static void debugger_off();
-static void keyboard_init();
-static void keyboard_panic();
-static void shutdown_status_panic();
-static void nmi_handler_msg();
-
-static void print_bios_banner();
-static void print_boot_device();
-static void print_boot_failure();
-static void print_cdromboot_failure();
-
-# if BX_USE_ATADRV
-
-// ATA / ATAPI driver
-void ata_init();
-void ata_detect();
-void ata_reset();
-
-Bit16u ata_cmd_non_data();
-Bit16u ata_cmd_data_in();
-Bit16u ata_cmd_data_out();
-Bit16u ata_cmd_packet();
-
-Bit16u atapi_get_sense();
-Bit16u atapi_is_ready();
-Bit16u atapi_is_cdrom();
-
-#endif // BX_USE_ATADRV
-
-#if BX_ELTORITO_BOOT
-
-void cdemu_init();
-Bit8u cdemu_isactive();
-Bit8u cdemu_emulated_drive();
-
-Bit16u cdrom_boot();
-
-#endif // BX_ELTORITO_BOOT
-
-static char bios_cvs_version_string[] = "$Revision: 1.163 $ $Date: 2006/07/07 16:10:37 $";
-
-#define BIOS_COPYRIGHT_STRING "(c) 2002 MandrakeSoft S.A. Written by Kevin Lawton & the Bochs team."
-
-#define BIOS_PRINTF_HALT 1
-#define BIOS_PRINTF_SCREEN 2
-#define BIOS_PRINTF_INFO 4
-#define BIOS_PRINTF_DEBUG 8
-#define BIOS_PRINTF_ALL (BIOS_PRINTF_SCREEN | BIOS_PRINTF_INFO)
-#define BIOS_PRINTF_DEBHALT (BIOS_PRINTF_SCREEN | BIOS_PRINTF_INFO | BIOS_PRINTF_HALT)
-
-#define printf(format, p...) bios_printf(BIOS_PRINTF_SCREEN, format, ##p)
-
-// Defines the output macros.
-// BX_DEBUG goes to INFO port until we can easily choose debug info on a
-// per-device basis. Debug info are sent only in debug mode
-#if DEBUG_ROMBIOS
-# define BX_DEBUG(format, p...) bios_printf(BIOS_PRINTF_INFO, format, ##p)
-#else
-# define BX_DEBUG(format, p...)
-#endif
-#define BX_INFO(format, p...) bios_printf(BIOS_PRINTF_INFO, format, ##p)
-#define BX_PANIC(format, p...) bios_printf(BIOS_PRINTF_DEBHALT, format, ##p)
-
-#if DEBUG_ATA
-# define BX_DEBUG_ATA(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_ATA(a...)
-#endif
-#if DEBUG_INT13_HD
-# define BX_DEBUG_INT13_HD(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT13_HD(a...)
-#endif
-#if DEBUG_INT13_CD
-# define BX_DEBUG_INT13_CD(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT13_CD(a...)
-#endif
-#if DEBUG_INT13_ET
-# define BX_DEBUG_INT13_ET(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT13_ET(a...)
-#endif
-#if DEBUG_INT13_FL
-# define BX_DEBUG_INT13_FL(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT13_FL(a...)
-#endif
-#if DEBUG_INT15
-# define BX_DEBUG_INT15(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT15(a...)
-#endif
-#if DEBUG_INT16
-# define BX_DEBUG_INT16(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT16(a...)
-#endif
-#if DEBUG_INT1A
-# define BX_DEBUG_INT1A(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT1A(a...)
-#endif
-#if DEBUG_INT74
-# define BX_DEBUG_INT74(a...) BX_DEBUG(a)
-#else
-# define BX_DEBUG_INT74(a...)
-#endif
-
-#define SET_AL(val8) AX = ((AX & 0xff00) | (val8))
-#define SET_BL(val8) BX = ((BX & 0xff00) | (val8))
-#define SET_CL(val8) CX = ((CX & 0xff00) | (val8))
-#define SET_DL(val8) DX = ((DX & 0xff00) | (val8))
-#define SET_AH(val8) AX = ((AX & 0x00ff) | ((val8) << 8))
-#define SET_BH(val8) BX = ((BX & 0x00ff) | ((val8) << 8))
-#define SET_CH(val8) CX = ((CX & 0x00ff) | ((val8) << 8))
-#define SET_DH(val8) DX = ((DX & 0x00ff) | ((val8) << 8))
-
-#define GET_AL() ( AX & 0x00ff )
-#define GET_BL() ( BX & 0x00ff )
-#define GET_CL() ( CX & 0x00ff )
-#define GET_DL() ( DX & 0x00ff )
-#define GET_AH() ( AX >> 8 )
-#define GET_BH() ( BX >> 8 )
-#define GET_CH() ( CX >> 8 )
-#define GET_DH() ( DX >> 8 )
-
-#define GET_ELDL() ( ELDX & 0x00ff )
-#define GET_ELDH() ( ELDX >> 8 )
-
-#define SET_CF() FLAGS |= 0x0001
-#define CLEAR_CF() FLAGS &= 0xfffe
-#define GET_CF() (FLAGS & 0x0001)
-
-#define SET_ZF() FLAGS |= 0x0040
-#define CLEAR_ZF() FLAGS &= 0xffbf
-#define GET_ZF() (FLAGS & 0x0040)
-
-#define UNSUPPORTED_FUNCTION 0x86
-
-#define none 0
-#define MAX_SCAN_CODE 0x58
-
-static struct {
- Bit16u normal;
- Bit16u shift;
- Bit16u control;
- Bit16u alt;
- Bit8u lock_flags;
- } scan_to_scanascii[MAX_SCAN_CODE + 1] = {
- { none, none, none, none, none },
- { 0x011b, 0x011b, 0x011b, 0x0100, none }, /* escape */
- { 0x0231, 0x0221, none, 0x7800, none }, /* 1! */
- { 0x0332, 0x0340, 0x0300, 0x7900, none }, /* 2@ */
- { 0x0433, 0x0423, none, 0x7a00, none }, /* 3# */
- { 0x0534, 0x0524, none, 0x7b00, none }, /* 4$ */
- { 0x0635, 0x0625, none, 0x7c00, none }, /* 5% */
- { 0x0736, 0x075e, 0x071e, 0x7d00, none }, /* 6^ */
- { 0x0837, 0x0826, none, 0x7e00, none }, /* 7& */
- { 0x0938, 0x092a, none, 0x7f00, none }, /* 8* */
- { 0x0a39, 0x0a28, none, 0x8000, none }, /* 9( */
- { 0x0b30, 0x0b29, none, 0x8100, none }, /* 0) */
- { 0x0c2d, 0x0c5f, 0x0c1f, 0x8200, none }, /* -_ */
- { 0x0d3d, 0x0d2b, none, 0x8300, none }, /* =+ */
- { 0x0e08, 0x0e08, 0x0e7f, none, none }, /* backspace */
- { 0x0f09, 0x0f00, none, none, none }, /* tab */
- { 0x1071, 0x1051, 0x1011, 0x1000, 0x40 }, /* Q */
- { 0x1177, 0x1157, 0x1117, 0x1100, 0x40 }, /* W */
- { 0x1265, 0x1245, 0x1205, 0x1200, 0x40 }, /* E */
- { 0x1372, 0x1352, 0x1312, 0x1300, 0x40 }, /* R */
- { 0x1474, 0x1454, 0x1414, 0x1400, 0x40 }, /* T */
- { 0x1579, 0x1559, 0x1519, 0x1500, 0x40 }, /* Y */
- { 0x1675, 0x1655, 0x1615, 0x1600, 0x40 }, /* U */
- { 0x1769, 0x1749, 0x1709, 0x1700, 0x40 }, /* I */
- { 0x186f, 0x184f, 0x180f, 0x1800, 0x40 }, /* O */
- { 0x1970, 0x1950, 0x1910, 0x1900, 0x40 }, /* P */
- { 0x1a5b, 0x1a7b, 0x1a1b, none, none }, /* [{ */
- { 0x1b5d, 0x1b7d, 0x1b1d, none, none }, /* ]} */
- { 0x1c0d, 0x1c0d, 0x1c0a, none, none }, /* Enter */
- { none, none, none, none, none }, /* L Ctrl */
- { 0x1e61, 0x1e41, 0x1e01, 0x1e00, 0x40 }, /* A */
- { 0x1f73, 0x1f53, 0x1f13, 0x1f00, 0x40 }, /* S */
- { 0x2064, 0x2044, 0x2004, 0x2000, 0x40 }, /* D */
- { 0x2166, 0x2146, 0x2106, 0x2100, 0x40 }, /* F */
- { 0x2267, 0x2247, 0x2207, 0x2200, 0x40 }, /* G */
- { 0x2368, 0x2348, 0x2308, 0x2300, 0x40 }, /* H */
- { 0x246a, 0x244a, 0x240a, 0x2400, 0x40 }, /* J */
- { 0x256b, 0x254b, 0x250b, 0x2500, 0x40 }, /* K */
- { 0x266c, 0x264c, 0x260c, 0x2600, 0x40 }, /* L */
- { 0x273b, 0x273a, none, none, none }, /* ;: */
- { 0x2827, 0x2822, none, none, none }, /* '" */
- { 0x2960, 0x297e, none, none, none }, /* `~ */
- { none, none, none, none, none }, /* L shift */
- { 0x2b5c, 0x2b7c, 0x2b1c, none, none }, /* |\ */
- { 0x2c7a, 0x2c5a, 0x2c1a, 0x2c00, 0x40 }, /* Z */
- { 0x2d78, 0x2d58, 0x2d18, 0x2d00, 0x40 }, /* X */
- { 0x2e63, 0x2e43, 0x2e03, 0x2e00, 0x40 }, /* C */
- { 0x2f76, 0x2f56, 0x2f16, 0x2f00, 0x40 }, /* V */
- { 0x3062, 0x3042, 0x3002, 0x3000, 0x40 }, /* B */
- { 0x316e, 0x314e, 0x310e, 0x3100, 0x40 }, /* N */
- { 0x326d, 0x324d, 0x320d, 0x3200, 0x40 }, /* M */
- { 0x332c, 0x333c, none, none, none }, /* ,< */
- { 0x342e, 0x343e, none, none, none }, /* .> */
- { 0x352f, 0x353f, none, none, none }, /* /? */
- { none, none, none, none, none }, /* R Shift */
- { 0x372a, 0x372a, none, none, none }, /* * */
- { none, none, none, none, none }, /* L Alt */
- { 0x3920, 0x3920, 0x3920, 0x3920, none }, /* space */
- { none, none, none, none, none }, /* caps lock */
- { 0x3b00, 0x5400, 0x5e00, 0x6800, none }, /* F1 */
- { 0x3c00, 0x5500, 0x5f00, 0x6900, none }, /* F2 */
- { 0x3d00, 0x5600, 0x6000, 0x6a00, none }, /* F3 */
- { 0x3e00, 0x5700, 0x6100, 0x6b00, none }, /* F4 */
- { 0x3f00, 0x5800, 0x6200, 0x6c00, none }, /* F5 */
- { 0x4000, 0x5900, 0x6300, 0x6d00, none }, /* F6 */
- { 0x4100, 0x5a00, 0x6400, 0x6e00, none }, /* F7 */
- { 0x4200, 0x5b00, 0x6500, 0x6f00, none }, /* F8 */
- { 0x4300, 0x5c00, 0x6600, 0x7000, none }, /* F9 */
- { 0x4400, 0x5d00, 0x6700, 0x7100, none }, /* F10 */
- { none, none, none, none, none }, /* Num Lock */
- { none, none, none, none, none }, /* Scroll Lock */
- { 0x4700, 0x4737, 0x7700, none, 0x20 }, /* 7 Home */
- { 0x4800, 0x4838, none, none, 0x20 }, /* 8 UP */
- { 0x4900, 0x4939, 0x8400, none, 0x20 }, /* 9 PgUp */
- { 0x4a2d, 0x4a2d, none, none, none }, /* - */
- { 0x4b00, 0x4b34, 0x7300, none, 0x20 }, /* 4 Left */
- { 0x4c00, 0x4c35, none, none, 0x20 }, /* 5 */
- { 0x4d00, 0x4d36, 0x7400, none, 0x20 }, /* 6 Right */
- { 0x4e2b, 0x4e2b, none, none, none }, /* + */
- { 0x4f00, 0x4f31, 0x7500, none, 0x20 }, /* 1 End */
- { 0x5000, 0x5032, none, none, 0x20 }, /* 2 Down */
- { 0x5100, 0x5133, 0x7600, none, 0x20 }, /* 3 PgDn */
- { 0x5200, 0x5230, none, none, 0x20 }, /* 0 Ins */
- { 0x5300, 0x532e, none, none, 0x20 }, /* Del */
- { none, none, none, none, none },
- { none, none, none, none, none },
- { none, none, none, none, none },
- { 0x5700, 0x5700, none, none, none }, /* F11 */
- { 0x5800, 0x5800, none, none, none } /* F12 */
- };
-
- Bit8u
-inb(port)
- Bit16u port;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push dx
- mov dx, 4[bp]
- in al, dx
- pop dx
-
- pop bp
-ASM_END
-}
-
-#if BX_USE_ATADRV
- Bit16u
-inw(port)
- Bit16u port;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push dx
- mov dx, 4[bp]
- in ax, dx
- pop dx
-
- pop bp
-ASM_END
-}
-#endif
-
- void
-outb(port, val)
- Bit16u port;
- Bit8u val;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push ax
- push dx
- mov dx, 4[bp]
- mov al, 6[bp]
- out dx, al
- pop dx
- pop ax
-
- pop bp
-ASM_END
-}
-
-#if BX_USE_ATADRV
- void
-outw(port, val)
- Bit16u port;
- Bit16u val;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push ax
- push dx
- mov dx, 4[bp]
- mov ax, 6[bp]
- out dx, ax
- pop dx
- pop ax
-
- pop bp
-ASM_END
-}
-#endif
-
- void
-outb_cmos(cmos_reg, val)
- Bit8u cmos_reg;
- Bit8u val;
-{
-ASM_START
- push bp
- mov bp, sp
-
- mov al, 4[bp] ;; cmos_reg
- out 0x70, al
- mov al, 6[bp] ;; val
- out 0x71, al
-
- pop bp
-ASM_END
-}
-
- Bit8u
-inb_cmos(cmos_reg)
- Bit8u cmos_reg;
-{
-ASM_START
- push bp
- mov bp, sp
-
- mov al, 4[bp] ;; cmos_reg
- out 0x70, al
- in al, 0x71
-
- pop bp
-ASM_END
-}
-
- void
-init_rtc()
-{
- outb_cmos(0x0a, 0x26);
- outb_cmos(0x0b, 0x02);
- inb_cmos(0x0c);
- inb_cmos(0x0d);
-}
-
- bx_bool
-rtc_updating()
-{
- // This function checks to see if the update-in-progress bit
- // is set in CMOS Status Register A. If not, it returns 0.
- // If it is set, it tries to wait until there is a transition
- // to 0, and will return 0 if such a transition occurs. A 1
- // is returned only after timing out. The maximum period
- // that this bit should be set is constrained to 244useconds.
- // The count I use below guarantees coverage or more than
- // this time, with any reasonable IPS setting.
-
- Bit16u count;
-
- count = 25000;
- while (--count != 0) {
- if ( (inb_cmos(0x0a) & 0x80) == 0 )
- return(0);
- }
- return(1); // update-in-progress never transitioned to 0
-}
-
-
- Bit8u
-read_byte(seg, offset)
- Bit16u seg;
- Bit16u offset;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push bx
- push ds
- mov ax, 4[bp] ; segment
- mov ds, ax
- mov bx, 6[bp] ; offset
- mov al, [bx]
- ;; al = return value (byte)
- pop ds
- pop bx
-
- pop bp
-ASM_END
-}
-
- Bit16u
-read_word(seg, offset)
- Bit16u seg;
- Bit16u offset;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push bx
- push ds
- mov ax, 4[bp] ; segment
- mov ds, ax
- mov bx, 6[bp] ; offset
- mov ax, [bx]
- ;; ax = return value (word)
- pop ds
- pop bx
-
- pop bp
-ASM_END
-}
-
- void
-write_byte(seg, offset, data)
- Bit16u seg;
- Bit16u offset;
- Bit8u data;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push ax
- push bx
- push ds
- mov ax, 4[bp] ; segment
- mov ds, ax
- mov bx, 6[bp] ; offset
- mov al, 8[bp] ; data byte
- mov [bx], al ; write data byte
- pop ds
- pop bx
- pop ax
-
- pop bp
-ASM_END
-}
-
- void
-write_word(seg, offset, data)
- Bit16u seg;
- Bit16u offset;
- Bit16u data;
-{
-ASM_START
- push bp
- mov bp, sp
-
- push ax
- push bx
- push ds
- mov ax, 4[bp] ; segment
- mov ds, ax
- mov bx, 6[bp] ; offset
- mov ax, 8[bp] ; data word
- mov [bx], ax ; write data word
- pop ds
- pop bx
- pop ax
-
- pop bp
-ASM_END
-}
-
- Bit16u
-get_CS()
-{
-ASM_START
- mov ax, cs
-ASM_END
-}
-
- Bit16u
-get_SS()
-{
-ASM_START
- mov ax, ss
-ASM_END
-}
-
-#if BX_DEBUG_SERIAL
-/* serial debug port*/
-#define BX_DEBUG_PORT 0x03f8
-
-/* data */
-#define UART_RBR 0x00
-#define UART_THR 0x00
-
-/* control */
-#define UART_IER 0x01
-#define UART_IIR 0x02
-#define UART_FCR 0x02
-#define UART_LCR 0x03
-#define UART_MCR 0x04
-#define UART_DLL 0x00
-#define UART_DLM 0x01
-
-/* status */
-#define UART_LSR 0x05
-#define UART_MSR 0x06
-#define UART_SCR 0x07
-
-int uart_can_tx_byte(base_port)
- Bit16u base_port;
-{
- return inb(base_port + UART_LSR) & 0x20;
-}
-
-void uart_wait_to_tx_byte(base_port)
- Bit16u base_port;
-{
- while (!uart_can_tx_byte(base_port));
-}
-
-void uart_wait_until_sent(base_port)
- Bit16u base_port;
-{
- while (!(inb(base_port + UART_LSR) & 0x40));
-}
-
-void uart_tx_byte(base_port, data)
- Bit16u base_port;
- Bit8u data;
-{
- uart_wait_to_tx_byte(base_port);
- outb(base_port + UART_THR, data);
- uart_wait_until_sent(base_port);
-}
-#endif
-
- void
-wrch(c)
- Bit8u c;
-{
- ASM_START
- push bp
- mov bp, sp
-
- push bx
- mov ah, #0x0e
- mov al, 4[bp]
- xor bx,bx
- int #0x10
- pop bx
-
- pop bp
- ASM_END
-}
-
- void
-send(action, c)
- Bit16u action;
- Bit8u c;
-{
-#if BX_DEBUG_SERIAL
- if (c == '\n') uart_tx_byte(BX_DEBUG_PORT, '\r');
- uart_tx_byte(BX_DEBUG_PORT, c);
-#endif
-#if BX_VIRTUAL_PORTS
- if (action & BIOS_PRINTF_DEBUG) outb(DEBUG_PORT, c);
- if (action & BIOS_PRINTF_INFO) outb(INFO_PORT, c);
-#endif
- if (action & BIOS_PRINTF_SCREEN) {
- if (c == '\n') wrch('\r');
- wrch(c);
- }
-}
-
- void
-put_int(action, val, width, neg)
- Bit16u action;
- short val, width;
- bx_bool neg;
-{
- short nval = val / 10;
- if (nval)
- put_int(action, nval, width - 1, neg);
- else {
- while (--width > 0) send(action, ' ');
- if (neg) send(action, '-');
- }
- send(action, val - (nval * 10) + '0');
-}
-
- void
-put_uint(action, val, width, neg)
- Bit16u action;
- unsigned short val;
- short width;
- bx_bool neg;
-{
- unsigned short nval = val / 10;
- if (nval)
- put_uint(action, nval, width - 1, neg);
- else {
- while (--width > 0) send(action, ' ');
- if (neg) send(action, '-');
- }
- send(action, val - (nval * 10) + '0');
-}
-
- void
-put_luint(action, val, width, neg)
- Bit16u action;
- unsigned long val;
- short width;
- bx_bool neg;
-{
- unsigned long nval = val / 10;
- if (nval)
- put_luint(action, nval, width - 1, neg);
- else {
- while (--width > 0) send(action, ' ');
- if (neg) send(action, '-');
- }
- send(action, val - (nval * 10) + '0');
-}
-
-//--------------------------------------------------------------------------
-// bios_printf()
-// A compact variable argument printf function which prints its output via
-// an I/O port so that it can be logged by Bochs/Plex.
-// Currently, only %x is supported (or %02x, %04x, etc).
-//
-// Supports %[format_width][format]
-// where format can be d,x,c,s
-//--------------------------------------------------------------------------
- void
-bios_printf(action, s)
- Bit16u action;
- Bit8u *s;
-{
- Bit8u c, format_char;
- bx_bool in_format;
- short i;
- Bit16u *arg_ptr;
- Bit16u arg_seg, arg, nibble, hibyte, shift_count, format_width;
-
- arg_ptr = &s;
- arg_seg = get_SS();
-
- in_format = 0;
- format_width = 0;
-
- if ((action & BIOS_PRINTF_DEBHALT) == BIOS_PRINTF_DEBHALT) {
-#if BX_VIRTUAL_PORTS
- outb(PANIC_PORT2, 0x00);
-#endif
- bios_printf (BIOS_PRINTF_SCREEN, "FATAL: ");
- }
-
- while (c = read_byte(get_CS(), s)) {
- if ( c == '%' ) {
- in_format = 1;
- format_width = 0;
- }
- else if (in_format) {
- if ( (c>='0') && (c<='9') ) {
- format_width = (format_width * 10) + (c - '0');
- }
- else {
- arg_ptr++; // increment to next arg
- arg = read_word(arg_seg, arg_ptr);
- if (c == 'x') {
- if (format_width == 0)
- format_width = 4;
- for (i=format_width-1; i>=0; i--) {
- nibble = (arg >> (4 * i)) & 0x000f;
- send (action, (nibble<=9)? (nibble+'0') : (nibble-10+'A'));
- }
- }
- else if (c == 'u') {
- put_uint(action, arg, format_width, 0);
- }
- else if (c == 'l') {
- s++;
- arg_ptr++; /* increment to next arg */
- hibyte = read_word(arg_seg, arg_ptr);
- put_luint(action, ((Bit32u) hibyte << 16) | arg, format_width, 0);
- }
- else if (c == 'd') {
- if (arg & 0x8000)
- put_int(action, -arg, format_width - 1, 1);
- else
- put_int(action, arg, format_width, 0);
- }
- else if (c == 's') {
- bios_printf(action & (~BIOS_PRINTF_HALT), arg);
- }
- else if (c == 'c') {
- send(action, arg);
- }
- else
- BX_PANIC("bios_printf: unknown format\n");
- in_format = 0;
- }
- }
- else {
- send(action, c);
- }
- s ++;
- }
-
- if (action & BIOS_PRINTF_HALT) {
- // freeze in a busy loop.
-ASM_START
- cli
- halt2_loop:
- hlt
- jmp halt2_loop
-ASM_END
- }
-}
-
-//--------------------------------------------------------------------------
-// keyboard_init
-//--------------------------------------------------------------------------
-// this file is based on coreboot implementation of keyboard.c
-// could convert to #asm to gain space
- void
-keyboard_init()
-{
-#ifndef COREBOOT
- Bit16u max;
-
- /* ------------------- Flush buffers ------------------------*/
- /* Wait until buffer is empty */
- max=0xffff;
- while ( (inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x00);
-
- /* flush incoming keys */
- max=0x2000;
- while (--max > 0) {
- outb(0x80, 0x00);
- if (inb(0x64) & 0x01) {
- inb(0x60);
- max = 0x2000;
- }
- }
-
- // Due to timer issues, and if the IPS setting is > 15000000,
- // the incoming keys might not be flushed here. That will
- // cause a panic a few lines below. See sourceforge bug report :
- // [ 642031 ] FATAL: Keyboard RESET error:993
-
- /* ------------------- controller side ----------------------*/
- /* send cmd = 0xAA, self test 8042 */
- outb(0x64, 0xaa);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ( (inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x00);
- if (max==0x0) keyboard_panic(00);
-
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x01);
- if (max==0x0) keyboard_panic(01);
-
- /* read self-test result, 0x55 should be returned from 0x60 */
- if ((inb(0x60) != 0x55)){
- keyboard_panic(991);
- }
-
- /* send cmd = 0xAB, keyboard interface test */
- outb(0x64,0xab);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ((inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x10);
- if (max==0x0) keyboard_panic(10);
-
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x11);
- if (max==0x0) keyboard_panic(11);
-
- /* read keyboard interface test result, */
- /* 0x00 should be returned form 0x60 */
- if ((inb(0x60) != 0x00)) {
- keyboard_panic(992);
- }
-
- /* Enable Keyboard clock */
- outb(0x64,0xae);
- outb(0x64,0xa8);
-
- /* ------------------- keyboard side ------------------------*/
- /* reset kerboard and self test (keyboard side) */
- outb(0x60, 0xff);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ((inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x20);
- if (max==0x0) keyboard_panic(20);
-
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x21);
- if (max==0x0) keyboard_panic(21);
-
- /* keyboard should return ACK */
- if ((inb(0x60) != 0xfa)) {
- keyboard_panic(993);
- }
-
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x31);
- if (max==0x0) keyboard_panic(31);
-
- if ((inb(0x60) != 0xaa)) {
- keyboard_panic(994);
- }
-
- /* Disable keyboard */
- outb(0x60, 0xf5);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ((inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x40);
- if (max==0x0) keyboard_panic(40);
-
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x41);
- if (max==0x0) keyboard_panic(41);
-
- /* keyboard should return ACK */
- if ((inb(0x60) != 0xfa)) {
- keyboard_panic(995);
- }
-
- /* Write Keyboard Mode */
- outb(0x64, 0x60);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ((inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x50);
- if (max==0x0) keyboard_panic(50);
-
- /* send cmd: scan code convert, disable mouse, enable IRQ 1 */
- outb(0x60, 0x61);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ((inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x60);
- if (max==0x0) keyboard_panic(60);
-
- /* Enable keyboard */
- outb(0x60, 0xf4);
-
- /* Wait until buffer is empty */
- max=0xffff;
- while ((inb(0x64) & 0x02) && (--max>0)) outb(0x80, 0x70);
- if (max==0x0) keyboard_panic(70);
-
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x71);
- if (max==0x0) keyboard_panic(70);
-
- /* keyboard should return ACK */
- if ((inb(0x60) != 0xfa)) {
- keyboard_panic(996);
- }
-
- outb(0x80, 0x77);
-#endif
-}
-
-//--------------------------------------------------------------------------
-// keyboard_panic
-//--------------------------------------------------------------------------
- void
-keyboard_panic(status)
- Bit16u status;
-{
- // If you're getting a 993 keyboard panic here,
- // please see the comment in keyboard_init
-
- BX_PANIC("Keyboard error:%u\n",status);
-}
-
-//--------------------------------------------------------------------------
-// shutdown_status_panic
-// called when the shutdown statsu is not implemented, displays the status
-//--------------------------------------------------------------------------
- void
-shutdown_status_panic(status)
- Bit16u status;
-{
- BX_PANIC("Unimplemented shutdown status: %02x\n",(Bit8u)status);
-}
-
-//--------------------------------------------------------------------------
-// print_bios_banner
-// displays a the bios version
-//--------------------------------------------------------------------------
-void
-print_bios_banner()
-{
- printf(BX_APPNAME" BIOS - build: %s\n%s\nOptions: ",
- BIOS_BUILD_DATE, bios_cvs_version_string);
- printf(
-#ifdef BX_PCIBIOS
- "pcibios "
-#endif
-#ifdef BX_ELTORITO_BOOT
- "eltorito "
-#endif
- "\n\n");
-}
-
-//--------------------------------------------------------------------------
-// print_boot_device
-// displays the boot device
-//--------------------------------------------------------------------------
-
-static char drivetypes[][10]={"Floppy","Hard Disk","CD-Rom"};
-
-void
-print_boot_device(cdboot, drive)
- Bit8u cdboot; Bit16u drive;
-{
- Bit8u i;
-
- // cdboot contains 0 if floppy/harddisk, 1 otherwise
- // drive contains real/emulated boot drive
-
- if(cdboot)i=2; // CD-Rom
- else if((drive&0x0080)==0x00)i=0; // Floppy
- else if((drive&0x0080)==0x80)i=1; // Hard drive
- else return;
-
- printf("Booting from %s...\n",drivetypes[i]);
-}
-
-//--------------------------------------------------------------------------
-// print_boot_failure
-// displays the reason why boot failed
-//--------------------------------------------------------------------------
- void
-print_boot_failure(cdboot, drive, reason, lastdrive)
- Bit8u cdboot; Bit8u drive; Bit8u lastdrive;
-{
- Bit16u drivenum = drive&0x7f;
-
- // cdboot: 1 if boot from cd, 0 otherwise
- // drive : drive number
- // reason: 0 signature check failed, 1 read error
- // lastdrive: 1 boot drive is the last one in boot sequence
-
- if (cdboot)
- bios_printf(BIOS_PRINTF_INFO | BIOS_PRINTF_SCREEN, "Boot from %s failed\n",drivetypes[2]);
- else if (drive & 0x80)
- bios_printf(BIOS_PRINTF_INFO | BIOS_PRINTF_SCREEN, "Boot from %s %d failed\n", drivetypes[1],drivenum);
- else
- bios_printf(BIOS_PRINTF_INFO | BIOS_PRINTF_SCREEN, "Boot from %s %d failed\n", drivetypes[0],drivenum);
-
- if (lastdrive==1) {
- if (reason==0)
- BX_PANIC("Not a bootable disk\n");
- else
- BX_PANIC("Could not read the boot disk\n");
- }
-}
-
-//--------------------------------------------------------------------------
-// print_cdromboot_failure
-// displays the reason why boot failed
-//--------------------------------------------------------------------------
- void
-print_cdromboot_failure( code )
- Bit16u code;
-{
- bios_printf(BIOS_PRINTF_SCREEN | BIOS_PRINTF_INFO, "CDROM boot failure code : %04x\n",code);
-
- return;
-}
-
-void
-nmi_handler_msg()
-{
- BX_PANIC("NMI Handler called\n");
-}
-
-void
-int18_panic_msg()
-{
- BX_PANIC("INT18: BOOT FAILURE\n");
-}
-
-void
-log_bios_start()
-{
-#if BX_DEBUG_SERIAL
- outb(BX_DEBUG_PORT+UART_LCR, 0x03); /* setup for serial logging: 8N1 */
-#endif
- BX_INFO("%s\n", bios_cvs_version_string);
-}
-
- bx_bool
-set_enable_a20(val)
- bx_bool val;
-{
- Bit8u oldval;
-
- // Use PS2 System Control port A to set A20 enable
-
- // get current setting first
- oldval = inb(0x92);
-
- // change A20 status
- if (val)
- outb(0x92, oldval | 0x02);
- else
- outb(0x92, oldval & 0xfd);
-
- return((oldval & 0x02) != 0);
-}
-
- void
-debugger_on()
-{
- outb(0xfedc, 0x01);
-}
-
- void
-debugger_off()
-{
- outb(0xfedc, 0x00);
-}
-
-#if BX_USE_ATADRV
-
-// ---------------------------------------------------------------------------
-// Start of ATA/ATAPI Driver
-// ---------------------------------------------------------------------------
-
-// Global defines -- ATA register and register bits.
-// command block & control block regs
-#define ATA_CB_DATA 0 // data reg in/out pio_base_addr1+0
-#define ATA_CB_ERR 1 // error in pio_base_addr1+1
-#define ATA_CB_FR 1 // feature reg out pio_base_addr1+1
-#define ATA_CB_SC 2 // sector count in/out pio_base_addr1+2
-#define ATA_CB_SN 3 // sector number in/out pio_base_addr1+3
-#define ATA_CB_CL 4 // cylinder low in/out pio_base_addr1+4
-#define ATA_CB_CH 5 // cylinder high in/out pio_base_addr1+5
-#define ATA_CB_DH 6 // device head in/out pio_base_addr1+6
-#define ATA_CB_STAT 7 // primary status in pio_base_addr1+7
-#define ATA_CB_CMD 7 // command out pio_base_addr1+7
-#define ATA_CB_ASTAT 6 // alternate status in pio_base_addr2+6
-#define ATA_CB_DC 6 // device control out pio_base_addr2+6
-#define ATA_CB_DA 7 // device address in pio_base_addr2+7
-
-#define ATA_CB_ER_ICRC 0x80 // ATA Ultra DMA bad CRC
-#define ATA_CB_ER_BBK 0x80 // ATA bad block
-#define ATA_CB_ER_UNC 0x40 // ATA uncorrected error
-#define ATA_CB_ER_MC 0x20 // ATA media change
-#define ATA_CB_ER_IDNF 0x10 // ATA id not found
-#define ATA_CB_ER_MCR 0x08 // ATA media change request
-#define ATA_CB_ER_ABRT 0x04 // ATA command aborted
-#define ATA_CB_ER_NTK0 0x02 // ATA track 0 not found
-#define ATA_CB_ER_NDAM 0x01 // ATA address mark not found
-
-#define ATA_CB_ER_P_SNSKEY 0xf0 // ATAPI sense key (mask)
-#define ATA_CB_ER_P_MCR 0x08 // ATAPI Media Change Request
-#define ATA_CB_ER_P_ABRT 0x04 // ATAPI command abort
-#define ATA_CB_ER_P_EOM 0x02 // ATAPI End of Media
-#define ATA_CB_ER_P_ILI 0x01 // ATAPI Illegal Length Indication
-
-// ATAPI Interrupt Reason bits in the Sector Count reg (CB_SC)
-#define ATA_CB_SC_P_TAG 0xf8 // ATAPI tag (mask)
-#define ATA_CB_SC_P_REL 0x04 // ATAPI release
-#define ATA_CB_SC_P_IO 0x02 // ATAPI I/O
-#define ATA_CB_SC_P_CD 0x01 // ATAPI C/D
-
-// bits 7-4 of the device/head (CB_DH) reg
-#define ATA_CB_DH_DEV0 0xa0 // select device 0
-#define ATA_CB_DH_DEV1 0xb0 // select device 1
-
-// status reg (CB_STAT and CB_ASTAT) bits
-#define ATA_CB_STAT_BSY 0x80 // busy
-#define ATA_CB_STAT_RDY 0x40 // ready
-#define ATA_CB_STAT_DF 0x20 // device fault
-#define ATA_CB_STAT_WFT 0x20 // write fault (old name)
-#define ATA_CB_STAT_SKC 0x10 // seek complete
-#define ATA_CB_STAT_SERV 0x10 // service
-#define ATA_CB_STAT_DRQ 0x08 // data request
-#define ATA_CB_STAT_CORR 0x04 // corrected
-#define ATA_CB_STAT_IDX 0x02 // index
-#define ATA_CB_STAT_ERR 0x01 // error (ATA)
-#define ATA_CB_STAT_CHK 0x01 // check (ATAPI)
-
-// device control reg (CB_DC) bits
-#define ATA_CB_DC_HD15 0x08 // bit should always be set to one
-#define ATA_CB_DC_SRST 0x04 // soft reset
-#define ATA_CB_DC_NIEN 0x02 // disable interrupts
-
-// Most mandtory and optional ATA commands (from ATA-3),
-#define ATA_CMD_CFA_ERASE_SECTORS 0xC0
-#define ATA_CMD_CFA_REQUEST_EXT_ERR_CODE 0x03
-#define ATA_CMD_CFA_TRANSLATE_SECTOR 0x87
-#define ATA_CMD_CFA_WRITE_MULTIPLE_WO_ERASE 0xCD
-#define ATA_CMD_CFA_WRITE_SECTORS_WO_ERASE 0x38
-#define ATA_CMD_CHECK_POWER_MODE1 0xE5
-#define ATA_CMD_CHECK_POWER_MODE2 0x98
-#define ATA_CMD_DEVICE_RESET 0x08
-#define ATA_CMD_EXECUTE_DEVICE_DIAGNOSTIC 0x90
-#define ATA_CMD_FLUSH_CACHE 0xE7
-#define ATA_CMD_FORMAT_TRACK 0x50
-#define ATA_CMD_IDENTIFY_DEVICE 0xEC
-#define ATA_CMD_IDENTIFY_DEVICE_PACKET 0xA1
-#define ATA_CMD_IDENTIFY_PACKET_DEVICE 0xA1
-#define ATA_CMD_IDLE1 0xE3
-#define ATA_CMD_IDLE2 0x97
-#define ATA_CMD_IDLE_IMMEDIATE1 0xE1
-#define ATA_CMD_IDLE_IMMEDIATE2 0x95
-#define ATA_CMD_INITIALIZE_DRIVE_PARAMETERS 0x91
-#define ATA_CMD_INITIALIZE_DEVICE_PARAMETERS 0x91
-#define ATA_CMD_NOP 0x00
-#define ATA_CMD_PACKET 0xA0
-#define ATA_CMD_READ_BUFFER 0xE4
-#define ATA_CMD_READ_DMA 0xC8
-#define ATA_CMD_READ_DMA_QUEUED 0xC7
-#define ATA_CMD_READ_MULTIPLE 0xC4
-#define ATA_CMD_READ_SECTORS 0x20
-#define ATA_CMD_READ_VERIFY_SECTORS 0x40
-#define ATA_CMD_RECALIBRATE 0x10
-#define ATA_CMD_SEEK 0x70
-#define ATA_CMD_SET_FEATURES 0xEF
-#define ATA_CMD_SET_MULTIPLE_MODE 0xC6
-#define ATA_CMD_SLEEP1 0xE6
-#define ATA_CMD_SLEEP2 0x99
-#define ATA_CMD_STANDBY1 0xE2
-#define ATA_CMD_STANDBY2 0x96
-#define ATA_CMD_STANDBY_IMMEDIATE1 0xE0
-#define ATA_CMD_STANDBY_IMMEDIATE2 0x94
-#define ATA_CMD_WRITE_BUFFER 0xE8
-#define ATA_CMD_WRITE_DMA 0xCA
-#define ATA_CMD_WRITE_DMA_QUEUED 0xCC
-#define ATA_CMD_WRITE_MULTIPLE 0xC5
-#define ATA_CMD_WRITE_SECTORS 0x30
-#define ATA_CMD_WRITE_VERIFY 0x3C
-
-#define ATA_IFACE_NONE 0x00
-#define ATA_IFACE_ISA 0x00
-#define ATA_IFACE_PCI 0x01
-
-#define ATA_TYPE_NONE 0x00
-#define ATA_TYPE_UNKNOWN 0x01
-#define ATA_TYPE_ATA 0x02
-#define ATA_TYPE_ATAPI 0x03
-
-#define ATA_DEVICE_NONE 0x00
-#define ATA_DEVICE_HD 0xFF
-#define ATA_DEVICE_CDROM 0x05
-
-#define ATA_MODE_NONE 0x00
-#define ATA_MODE_PIO16 0x00
-#define ATA_MODE_PIO32 0x01
-#define ATA_MODE_ISADMA 0x02
-#define ATA_MODE_PCIDMA 0x03
-#define ATA_MODE_USEIRQ 0x10
-
-#define ATA_TRANSLATION_NONE 0
-#define ATA_TRANSLATION_LBA 1
-#define ATA_TRANSLATION_LARGE 2
-#define ATA_TRANSLATION_RECHS 3
-
-#define ATA_DATA_NO 0x00
-#define ATA_DATA_IN 0x01
-#define ATA_DATA_OUT 0x02
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : initialization
-// ---------------------------------------------------------------------------
-void ata_init( )
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u channel, device;
-
- // Channels info init.
- for (channel=0; channel<BX_MAX_ATA_INTERFACES; channel++) {
- write_byte(ebda_seg,&EbdaData->ata.channels[channel].iface,ATA_IFACE_NONE);
- write_word(ebda_seg,&EbdaData->ata.channels[channel].iobase1,0x0);
- write_word(ebda_seg,&EbdaData->ata.channels[channel].iobase2,0x0);
- write_byte(ebda_seg,&EbdaData->ata.channels[channel].irq,0);
- }
-
- // Devices info init.
- for (device=0; device<BX_MAX_ATA_DEVICES; device++) {
- write_byte(ebda_seg,&EbdaData->ata.devices[device].type,ATA_TYPE_NONE);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].device,ATA_DEVICE_NONE);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].removable,0);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].lock,0);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].mode,ATA_MODE_NONE);
- write_word(ebda_seg,&EbdaData->ata.devices[device].blksize,0);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].translation,ATA_TRANSLATION_NONE);
- write_word(ebda_seg,&EbdaData->ata.devices[device].lchs.heads,0);
- write_word(ebda_seg,&EbdaData->ata.devices[device].lchs.cylinders,0);
- write_word(ebda_seg,&EbdaData->ata.devices[device].lchs.spt,0);
- write_word(ebda_seg,&EbdaData->ata.devices[device].pchs.heads,0);
- write_word(ebda_seg,&EbdaData->ata.devices[device].pchs.cylinders,0);
- write_word(ebda_seg,&EbdaData->ata.devices[device].pchs.spt,0);
-
- write_dword(ebda_seg,&EbdaData->ata.devices[device].sectors,0L);
- }
-
- // hdidmap and cdidmap init.
- for (device=0; device<BX_MAX_ATA_DEVICES; device++) {
- write_byte(ebda_seg,&EbdaData->ata.hdidmap[device],BX_MAX_ATA_DEVICES);
- write_byte(ebda_seg,&EbdaData->ata.cdidmap[device],BX_MAX_ATA_DEVICES);
- }
-
- write_byte(ebda_seg,&EbdaData->ata.hdcount,0);
- write_byte(ebda_seg,&EbdaData->ata.cdcount,0);
-}
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : device detection
-// ---------------------------------------------------------------------------
-
-void ata_detect( )
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u hdcount, cdcount, device, type;
- Bit8u buffer[0x0200];
- Bit16u i;
-
-#if BX_MAX_ATA_INTERFACES > 0
- write_byte(ebda_seg,&EbdaData->ata.channels[0].iface,ATA_IFACE_ISA);
- write_word(ebda_seg,&EbdaData->ata.channels[0].iobase1,0x1f0);
- write_word(ebda_seg,&EbdaData->ata.channels[0].iobase2,0x3f0);
- write_byte(ebda_seg,&EbdaData->ata.channels[0].irq,14);
-#endif
-#if BX_MAX_ATA_INTERFACES > 1
- write_byte(ebda_seg,&EbdaData->ata.channels[1].iface,ATA_IFACE_ISA);
- write_word(ebda_seg,&EbdaData->ata.channels[1].iobase1,0x170);
- write_word(ebda_seg,&EbdaData->ata.channels[1].iobase2,0x370);
- write_byte(ebda_seg,&EbdaData->ata.channels[1].irq,15);
-#endif
-#if BX_MAX_ATA_INTERFACES > 2
- write_byte(ebda_seg,&EbdaData->ata.channels[2].iface,ATA_IFACE_ISA);
- write_word(ebda_seg,&EbdaData->ata.channels[2].iobase1,0x1e8);
- write_word(ebda_seg,&EbdaData->ata.channels[2].iobase2,0x3e0);
- write_byte(ebda_seg,&EbdaData->ata.channels[2].irq,12);
-#endif
-#if BX_MAX_ATA_INTERFACES > 3
- write_byte(ebda_seg,&EbdaData->ata.channels[3].iface,ATA_IFACE_ISA);
- write_word(ebda_seg,&EbdaData->ata.channels[3].iobase1,0x168);
- write_word(ebda_seg,&EbdaData->ata.channels[3].iobase2,0x360);
- write_byte(ebda_seg,&EbdaData->ata.channels[3].irq,11);
-#endif
-#if BX_MAX_ATA_INTERFACES > 4
-#error Please fill the ATA interface informations
-#endif
-
- // Device detection
- hdcount=cdcount=0;
-
- for(device=0; device<BX_MAX_ATA_DEVICES; device++) {
- Bit16u iobase1, iobase2;
- Bit8u channel, slave, shift;
- Bit8u sc, sn, cl, ch, st;
-
- channel = device / 2;
- slave = device % 2;
-
- iobase1 =read_word(ebda_seg,&EbdaData->ata.channels[channel].iobase1);
- iobase2 =read_word(ebda_seg,&EbdaData->ata.channels[channel].iobase2);
-
- // Disable interrupts
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15 | ATA_CB_DC_NIEN);
-
- // Look for device
- outb(iobase1+ATA_CB_DH, slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0);
- outb(iobase1+ATA_CB_SC, 0x55);
- outb(iobase1+ATA_CB_SN, 0xaa);
- outb(iobase1+ATA_CB_SC, 0xaa);
- outb(iobase1+ATA_CB_SN, 0x55);
- outb(iobase1+ATA_CB_SC, 0x55);
- outb(iobase1+ATA_CB_SN, 0xaa);
-
- // If we found something
- sc = inb(iobase1+ATA_CB_SC);
- sn = inb(iobase1+ATA_CB_SN);
-
- if ( (sc == 0x55) && (sn == 0xaa) ) {
- write_byte(ebda_seg,&EbdaData->ata.devices[device].type,ATA_TYPE_UNKNOWN);
-
- // reset the channel
- ata_reset(device);
-
- // check for ATA or ATAPI
- outb(iobase1+ATA_CB_DH, slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0);
- sc = inb(iobase1+ATA_CB_SC);
- sn = inb(iobase1+ATA_CB_SN);
- if ((sc==0x01) && (sn==0x01)) {
- cl = inb(iobase1+ATA_CB_CL);
- ch = inb(iobase1+ATA_CB_CH);
- st = inb(iobase1+ATA_CB_STAT);
-
- if ((cl==0x14) && (ch==0xeb)) {
- write_byte(ebda_seg,&EbdaData->ata.devices[device].type,ATA_TYPE_ATAPI);
- } else if ((cl==0x00) && (ch==0x00) && (st!=0x00)) {
- write_byte(ebda_seg,&EbdaData->ata.devices[device].type,ATA_TYPE_ATA);
- } else if ((cl==0xff) && (ch==0xff)) {
- write_byte(ebda_seg,&EbdaData->ata.devices[device].type,ATA_TYPE_NONE);
- }
- }
- }
-
- type=read_byte(ebda_seg,&EbdaData->ata.devices[device].type);
-
- // Now we send a IDENTIFY command to ATA device
- if(type == ATA_TYPE_ATA) {
- Bit32u sectors;
- Bit16u cylinders, heads, spt, blksize;
- Bit8u translation, removable, mode;
-
- //Temporary values to do the transfer
- write_byte(ebda_seg,&EbdaData->ata.devices[device].device,ATA_DEVICE_HD);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].mode, ATA_MODE_PIO16);
-
- if (ata_cmd_data_in(device,ATA_CMD_IDENTIFY_DEVICE, 1, 0, 0, 0, 0L, get_SS(),buffer) !=0 )
- BX_PANIC("ata-detect: Failed to detect ATA device\n");
-
- removable = (read_byte(get_SS(),buffer+0) & 0x80) ? 1 : 0;
- mode = read_byte(get_SS(),buffer+96) ? ATA_MODE_PIO32 : ATA_MODE_PIO16;
- blksize = read_word(get_SS(),buffer+10);
-
- cylinders = read_word(get_SS(),buffer+(1*2)); // word 1
- heads = read_word(get_SS(),buffer+(3*2)); // word 3
- spt = read_word(get_SS(),buffer+(6*2)); // word 6
-
- sectors = read_dword(get_SS(),buffer+(60*2)); // word 60 and word 61
-
- write_byte(ebda_seg,&EbdaData->ata.devices[device].device,ATA_DEVICE_HD);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].removable, removable);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].mode, mode);
- write_word(ebda_seg,&EbdaData->ata.devices[device].blksize, blksize);
- write_word(ebda_seg,&EbdaData->ata.devices[device].pchs.heads, heads);
- write_word(ebda_seg,&EbdaData->ata.devices[device].pchs.cylinders, cylinders);
- write_word(ebda_seg,&EbdaData->ata.devices[device].pchs.spt, spt);
- write_dword(ebda_seg,&EbdaData->ata.devices[device].sectors, sectors);
- BX_INFO("ata%d-%d: PCHS=%u/%d/%d translation=", channel, slave,cylinders, heads, spt);
-
- translation = inb_cmos(0x39 + channel/2);
- for (shift=device%4; shift>0; shift--) translation >>= 2;
- translation &= 0x03;
-
- write_byte(ebda_seg,&EbdaData->ata.devices[device].translation, translation);
-
- switch (translation) {
- case ATA_TRANSLATION_NONE:
- BX_INFO("none");
- break;
- case ATA_TRANSLATION_LBA:
- BX_INFO("lba");
- break;
- case ATA_TRANSLATION_LARGE:
- BX_INFO("large");
- break;
- case ATA_TRANSLATION_RECHS:
- BX_INFO("r-echs");
- break;
- }
- switch (translation) {
- case ATA_TRANSLATION_NONE:
- break;
- case ATA_TRANSLATION_LBA:
- spt = 63;
- sectors /= 63;
- heads = sectors / 1024;
- if (heads>128) heads = 255;
- else if (heads>64) heads = 128;
- else if (heads>32) heads = 64;
- else if (heads>16) heads = 32;
- else heads=16;
- cylinders = sectors / heads;
- break;
- case ATA_TRANSLATION_RECHS:
- // Take care not to overflow
- if (heads==16) {
- if(cylinders>61439) cylinders=61439;
- heads=15;
- cylinders = (Bit16u)((Bit32u)(cylinders)*16/15);
- }
- // then go through the large bitshift process
- case ATA_TRANSLATION_LARGE:
- while(cylinders > 1024) {
- cylinders >>= 1;
- heads <<= 1;
-
- // If we max out the head count
- if (heads > 127) break;
- }
- break;
- }
- // clip to 1024 cylinders in lchs
- if (cylinders > 1024) cylinders=1024;
- BX_INFO(" LCHS=%d/%d/%d\n", cylinders, heads, spt);
-
- write_word(ebda_seg,&EbdaData->ata.devices[device].lchs.heads, heads);
- write_word(ebda_seg,&EbdaData->ata.devices[device].lchs.cylinders, cylinders);
- write_word(ebda_seg,&EbdaData->ata.devices[device].lchs.spt, spt);
-
- // fill hdidmap
- write_byte(ebda_seg,&EbdaData->ata.hdidmap[hdcount], device);
- hdcount++;
- }
-
- // Now we send a IDENTIFY command to ATAPI device
- if(type == ATA_TYPE_ATAPI) {
-
- Bit8u type, removable, mode;
- Bit16u blksize;
-
- //Temporary values to do the transfer
- write_byte(ebda_seg,&EbdaData->ata.devices[device].device,ATA_DEVICE_CDROM);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].mode, ATA_MODE_PIO16);
-
- if (ata_cmd_data_in(device,ATA_CMD_IDENTIFY_DEVICE_PACKET, 1, 0, 0, 0, 0L, get_SS(),buffer) != 0)
- BX_PANIC("ata-detect: Failed to detect ATAPI device\n");
-
- type = read_byte(get_SS(),buffer+1) & 0x1f;
- removable = (read_byte(get_SS(),buffer+0) & 0x80) ? 1 : 0;
- mode = read_byte(get_SS(),buffer+96) ? ATA_MODE_PIO32 : ATA_MODE_PIO16;
- blksize = 2048;
-
- write_byte(ebda_seg,&EbdaData->ata.devices[device].device, type);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].removable, removable);
- write_byte(ebda_seg,&EbdaData->ata.devices[device].mode, mode);
- write_word(ebda_seg,&EbdaData->ata.devices[device].blksize, blksize);
-
- // fill cdidmap
- write_byte(ebda_seg,&EbdaData->ata.cdidmap[cdcount], device);
- cdcount++;
- }
-
- {
- Bit32u sizeinmb;
- Bit16u ataversion;
- Bit8u c, i, version, model[41];
-
- switch (type) {
- case ATA_TYPE_ATA:
- sizeinmb = read_dword(ebda_seg,&EbdaData->ata.devices[device].sectors);
- sizeinmb >>= 11;
- case ATA_TYPE_ATAPI:
- // Read ATA/ATAPI version
- ataversion=((Bit16u)(read_byte(get_SS(),buffer+161))<<8)|read_byte(get_SS(),buffer+160);
- for(version=15;version>0;version--) {
- if((ataversion&(1<<version))!=0)
- break;
- }
-
- // Read model name
- for(i=0;i<20;i++){
- write_byte(get_SS(),model+(i*2),read_byte(get_SS(),buffer+(i*2)+54+1));
- write_byte(get_SS(),model+(i*2)+1,read_byte(get_SS(),buffer+(i*2)+54));
- }
-
- // Reformat
- write_byte(get_SS(),model+40,0x00);
- for(i=39;i>0;i--){
- if(read_byte(get_SS(),model+i)==0x20)
- write_byte(get_SS(),model+i,0x00);
- else break;
- }
- break;
- }
-
- switch (type) {
- case ATA_TYPE_ATA:
- printf("ata%d %s: ",channel,slave?" slave":"master");
- i=0; while(c=read_byte(get_SS(),model+i++)) printf("%c",c);
- printf(" ATA-%d Hard-Disk (%lu MBytes)\n", version, sizeinmb);
- break;
- case ATA_TYPE_ATAPI:
- printf("ata%d %s: ",channel,slave?" slave":"master");
- i=0; while(c=read_byte(get_SS(),model+i++)) printf("%c",c);
- if(read_byte(ebda_seg,&EbdaData->ata.devices[device].device)==ATA_DEVICE_CDROM)
- printf(" ATAPI-%d CD-Rom/DVD-Rom\n",version);
- else
- printf(" ATAPI-%d Device\n",version);
- break;
- case ATA_TYPE_UNKNOWN:
- printf("ata%d %s: Unknown device\n",channel,slave?" slave":"master");
- break;
- }
- }
- }
-
- // Store the devices counts
- write_byte(ebda_seg,&EbdaData->ata.hdcount, hdcount);
- write_byte(ebda_seg,&EbdaData->ata.cdcount, cdcount);
- write_byte(0x40,0x75, hdcount);
-
- printf("\n");
-
- // FIXME : should use bios=cmos|auto|disable bits
- // FIXME : should know about translation bits
- // FIXME : move hard_drive_post here
-
-}
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : software reset
-// ---------------------------------------------------------------------------
-// ATA-3
-// 8.2.1 Software reset - Device 0
-
-void ata_reset(device)
-Bit16u device;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit16u iobase1, iobase2;
- Bit8u channel, slave, sn, sc;
- Bit16u max;
-
- channel = device / 2;
- slave = device % 2;
-
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
- iobase2 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase2);
-
- // Reset
-
-// 8.2.1 (a) -- set SRST in DC
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15 | ATA_CB_DC_NIEN | ATA_CB_DC_SRST);
-
-// 8.2.1 (b) -- wait for BSY
- max=0xff;
- while(--max>0) {
- Bit8u status = inb(iobase1+ATA_CB_STAT);
- if ((status & ATA_CB_STAT_BSY) != 0) break;
- }
-
-// 8.2.1 (f) -- clear SRST
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15 | ATA_CB_DC_NIEN);
-
- if (read_byte(ebda_seg,&EbdaData->ata.devices[device].type) != ATA_TYPE_NONE) {
-
-// 8.2.1 (g) -- check for sc==sn==0x01
- // select device
- outb(iobase1+ATA_CB_DH, slave?ATA_CB_DH_DEV1:ATA_CB_DH_DEV0);
- sc = inb(iobase1+ATA_CB_SC);
- sn = inb(iobase1+ATA_CB_SN);
-
- if ( (sc==0x01) && (sn==0x01) ) {
-
-// 8.2.1 (h) -- wait for not BSY
- max=0xff;
- while(--max>0) {
- Bit8u status = inb(iobase1+ATA_CB_STAT);
- if ((status & ATA_CB_STAT_BSY) == 0) break;
- }
- }
- }
-
-// 8.2.1 (i) -- wait for DRDY
- max=0xfff;
- while(--max>0) {
- Bit8u status = inb(iobase1+ATA_CB_STAT);
- if ((status & ATA_CB_STAT_RDY) != 0) break;
- }
-
- // Enable interrupts
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15);
-}
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : execute a non data command
-// ---------------------------------------------------------------------------
-
-Bit16u ata_cmd_non_data()
-{return 0;}
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : execute a data-in command
-// ---------------------------------------------------------------------------
- // returns
- // 0 : no error
- // 1 : BUSY bit set
- // 2 : read error
- // 3 : expected DRQ=1
- // 4 : no sectors left to read/verify
- // 5 : more sectors to read/verify
- // 6 : no sectors left to write
- // 7 : more sectors to write
-Bit16u ata_cmd_data_in(device, command, count, cylinder, head, sector, lba, segment, offset)
-Bit16u device, command, count, cylinder, head, sector, segment, offset;
-Bit32u lba;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit16u iobase1, iobase2, blksize;
- Bit8u channel, slave;
- Bit8u status, current, mode;
-
- channel = device / 2;
- slave = device % 2;
-
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
- iobase2 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase2);
- mode = read_byte(ebda_seg, &EbdaData->ata.devices[device].mode);
- blksize = 0x200; // was = read_word(ebda_seg, &EbdaData->ata.devices[device].blksize);
- if (mode == ATA_MODE_PIO32) blksize>>=2;
- else blksize>>=1;
-
- // sector will be 0 only on lba access. Convert to lba-chs
- if (sector == 0) {
- sector = (Bit16u) (lba & 0x000000ffL);
- lba >>= 8;
- cylinder = (Bit16u) (lba & 0x0000ffffL);
- lba >>= 16;
- head = ((Bit16u) (lba & 0x0000000fL)) | 0x40;
- }
-
- // Reset count of transferred data
- write_word(ebda_seg, &EbdaData->ata.trsfsectors,0);
- write_dword(ebda_seg, &EbdaData->ata.trsfbytes,0L);
- current = 0;
-
- status = inb(iobase1 + ATA_CB_STAT);
- if (status & ATA_CB_STAT_BSY) return 1;
-
- outb(iobase2 + ATA_CB_DC, ATA_CB_DC_HD15 | ATA_CB_DC_NIEN);
- outb(iobase1 + ATA_CB_FR, 0x00);
- outb(iobase1 + ATA_CB_SC, count);
- outb(iobase1 + ATA_CB_SN, sector);
- outb(iobase1 + ATA_CB_CL, cylinder & 0x00ff);
- outb(iobase1 + ATA_CB_CH, cylinder >> 8);
- outb(iobase1 + ATA_CB_DH, (slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0) | (Bit8u) head );
- outb(iobase1 + ATA_CB_CMD, command);
-
- while (1) {
- status = inb(iobase1 + ATA_CB_STAT);
- if ( !(status & ATA_CB_STAT_BSY) ) break;
- }
-
- if (status & ATA_CB_STAT_ERR) {
- BX_DEBUG_ATA("ata_cmd_data_in : read error\n");
- return 2;
- } else if ( !(status & ATA_CB_STAT_DRQ) ) {
- BX_DEBUG_ATA("ata_cmd_data_in : DRQ not set (status %02x)\n", (unsigned) status);
- return 3;
- }
-
- // FIXME : move seg/off translation here
-
-ASM_START
- sti ;; enable higher priority interrupts
-ASM_END
-
- while (1) {
-
-ASM_START
- push bp
- mov bp, sp
- mov di, _ata_cmd_data_in.offset + 2[bp]
- mov ax, _ata_cmd_data_in.segment + 2[bp]
- mov cx, _ata_cmd_data_in.blksize + 2[bp]
-
- ;; adjust if there will be an overrun. 2K max sector size
- cmp di, #0xf800 ;;
- jbe ata_in_no_adjust
-
-ata_in_adjust:
- sub di, #0x0800 ;; sub 2 kbytes from offset
- add ax, #0x0080 ;; add 2 Kbytes to segment
-
-ata_in_no_adjust:
- mov es, ax ;; segment in es
-
- mov dx, _ata_cmd_data_in.iobase1 + 2[bp] ;; ATA data read port
-
- mov ah, _ata_cmd_data_in.mode + 2[bp]
- cmp ah, #ATA_MODE_PIO32
- je ata_in_32
-
-ata_in_16:
- rep
- insw ;; CX words transfered from port(DX) to ES:[DI]
- jmp ata_in_done
-
-ata_in_32:
- rep
- insd ;; CX dwords transfered from port(DX) to ES:[DI]
-
-ata_in_done:
- mov _ata_cmd_data_in.offset + 2[bp], di
- mov _ata_cmd_data_in.segment + 2[bp], es
- pop bp
-ASM_END
-
- current++;
- write_word(ebda_seg, &EbdaData->ata.trsfsectors,current);
- count--;
- status = inb(iobase1 + ATA_CB_STAT);
- if (count == 0) {
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR) )
- != ATA_CB_STAT_RDY ) {
- BX_DEBUG_ATA("ata_cmd_data_in : no sectors left (status %02x)\n", (unsigned) status);
- return 4;
- }
- break;
- }
- else {
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR) )
- != (ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ) ) {
- BX_DEBUG_ATA("ata_cmd_data_in : more sectors left (status %02x)\n", (unsigned) status);
- return 5;
- }
- continue;
- }
- }
- // Enable interrupts
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15);
- return 0;
-}
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : execute a data-out command
-// ---------------------------------------------------------------------------
- // returns
- // 0 : no error
- // 1 : BUSY bit set
- // 2 : read error
- // 3 : expected DRQ=1
- // 4 : no sectors left to read/verify
- // 5 : more sectors to read/verify
- // 6 : no sectors left to write
- // 7 : more sectors to write
-Bit16u ata_cmd_data_out(device, command, count, cylinder, head, sector, lba, segment, offset)
-Bit16u device, command, count, cylinder, head, sector, segment, offset;
-Bit32u lba;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit16u iobase1, iobase2, blksize;
- Bit8u channel, slave;
- Bit8u status, current, mode;
-
- channel = device / 2;
- slave = device % 2;
-
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
- iobase2 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase2);
- mode = read_byte(ebda_seg, &EbdaData->ata.devices[device].mode);
- blksize = 0x200; // was = read_word(ebda_seg, &EbdaData->ata.devices[device].blksize);
- if (mode == ATA_MODE_PIO32) blksize>>=2;
- else blksize>>=1;
-
- // sector will be 0 only on lba access. Convert to lba-chs
- if (sector == 0) {
- sector = (Bit16u) (lba & 0x000000ffL);
- lba >>= 8;
- cylinder = (Bit16u) (lba & 0x0000ffffL);
- lba >>= 16;
- head = ((Bit16u) (lba & 0x0000000fL)) | 0x40;
- }
-
- // Reset count of transferred data
- write_word(ebda_seg, &EbdaData->ata.trsfsectors,0);
- write_dword(ebda_seg, &EbdaData->ata.trsfbytes,0L);
- current = 0;
-
- status = inb(iobase1 + ATA_CB_STAT);
- if (status & ATA_CB_STAT_BSY) return 1;
-
- outb(iobase2 + ATA_CB_DC, ATA_CB_DC_HD15 | ATA_CB_DC_NIEN);
- outb(iobase1 + ATA_CB_FR, 0x00);
- outb(iobase1 + ATA_CB_SC, count);
- outb(iobase1 + ATA_CB_SN, sector);
- outb(iobase1 + ATA_CB_CL, cylinder & 0x00ff);
- outb(iobase1 + ATA_CB_CH, cylinder >> 8);
- outb(iobase1 + ATA_CB_DH, (slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0) | (Bit8u) head );
- outb(iobase1 + ATA_CB_CMD, command);
-
- while (1) {
- status = inb(iobase1 + ATA_CB_STAT);
- if ( !(status & ATA_CB_STAT_BSY) ) break;
- }
-
- if (status & ATA_CB_STAT_ERR) {
- BX_DEBUG_ATA("ata_cmd_data_out : read error\n");
- return 2;
- } else if ( !(status & ATA_CB_STAT_DRQ) ) {
- BX_DEBUG_ATA("ata_cmd_data_out : DRQ not set (status %02x)\n", (unsigned) status);
- return 3;
- }
-
- // FIXME : move seg/off translation here
-
-ASM_START
- sti ;; enable higher priority interrupts
-ASM_END
-
- while (1) {
-
-ASM_START
- push bp
- mov bp, sp
- mov si, _ata_cmd_data_out.offset + 2[bp]
- mov ax, _ata_cmd_data_out.segment + 2[bp]
- mov cx, _ata_cmd_data_out.blksize + 2[bp]
-
- ;; adjust if there will be an overrun. 2K max sector size
- cmp si, #0xf800 ;;
- jbe ata_out_no_adjust
-
-ata_out_adjust:
- sub si, #0x0800 ;; sub 2 kbytes from offset
- add ax, #0x0080 ;; add 2 Kbytes to segment
-
-ata_out_no_adjust:
- mov es, ax ;; segment in es
-
- mov dx, _ata_cmd_data_out.iobase1 + 2[bp] ;; ATA data write port
-
- mov ah, _ata_cmd_data_out.mode + 2[bp]
- cmp ah, #ATA_MODE_PIO32
- je ata_out_32
-
-ata_out_16:
- seg ES
- rep
- outsw ;; CX words transfered from port(DX) to ES:[SI]
- jmp ata_out_done
-
-ata_out_32:
- seg ES
- rep
- outsd ;; CX dwords transfered from port(DX) to ES:[SI]
-
-ata_out_done:
- mov _ata_cmd_data_out.offset + 2[bp], si
- mov _ata_cmd_data_out.segment + 2[bp], es
- pop bp
-ASM_END
-
- current++;
- write_word(ebda_seg, &EbdaData->ata.trsfsectors,current);
- count--;
- status = inb(iobase1 + ATA_CB_STAT);
- if (count == 0) {
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_RDY | ATA_CB_STAT_DF | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR) )
- != ATA_CB_STAT_RDY ) {
- BX_DEBUG_ATA("ata_cmd_data_out : no sectors left (status %02x)\n", (unsigned) status);
- return 6;
- }
- break;
- }
- else {
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR) )
- != (ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ) ) {
- BX_DEBUG_ATA("ata_cmd_data_out : more sectors left (status %02x)\n", (unsigned) status);
- return 7;
- }
- continue;
- }
- }
- // Enable interrupts
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15);
- return 0;
-}
-
-// ---------------------------------------------------------------------------
-// ATA/ATAPI driver : execute a packet command
-// ---------------------------------------------------------------------------
- // returns
- // 0 : no error
- // 1 : error in parameters
- // 2 : BUSY bit set
- // 3 : error
- // 4 : not ready
-Bit16u ata_cmd_packet(device, cmdlen, cmdseg, cmdoff, header, length, inout, bufseg, bufoff)
-Bit8u cmdlen,inout;
-Bit16u device,cmdseg, cmdoff, bufseg, bufoff;
-Bit16u header;
-Bit32u length;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit16u iobase1, iobase2;
- Bit16u lcount, lbefore, lafter, count;
- Bit8u channel, slave;
- Bit8u status, mode, lmode;
- Bit32u total, transfer;
-
- channel = device / 2;
- slave = device % 2;
-
- // Data out is not supported yet
- if (inout == ATA_DATA_OUT) {
- BX_INFO("ata_cmd_packet: DATA_OUT not supported yet\n");
- return 1;
- }
-
- // The header length must be even
- if (header & 1) {
- BX_DEBUG_ATA("ata_cmd_packet : header must be even (%04x)\n",header);
- return 1;
- }
-
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
- iobase2 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase2);
- mode = read_byte(ebda_seg, &EbdaData->ata.devices[device].mode);
- transfer= 0L;
-
- if (cmdlen < 12) cmdlen=12;
- if (cmdlen > 12) cmdlen=16;
- cmdlen>>=1;
-
- // Reset count of transferred data
- write_word(ebda_seg, &EbdaData->ata.trsfsectors,0);
- write_dword(ebda_seg, &EbdaData->ata.trsfbytes,0L);
-
- status = inb(iobase1 + ATA_CB_STAT);
- if (status & ATA_CB_STAT_BSY) return 2;
-
- outb(iobase2 + ATA_CB_DC, ATA_CB_DC_HD15 | ATA_CB_DC_NIEN);
- // outb(iobase1 + ATA_CB_FR, 0x00);
- // outb(iobase1 + ATA_CB_SC, 0x00);
- // outb(iobase1 + ATA_CB_SN, 0x00);
- outb(iobase1 + ATA_CB_CL, 0xfff0 & 0x00ff);
- outb(iobase1 + ATA_CB_CH, 0xfff0 >> 8);
- outb(iobase1 + ATA_CB_DH, slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0);
- outb(iobase1 + ATA_CB_CMD, ATA_CMD_PACKET);
-
- // Device should ok to receive command
- while (1) {
- status = inb(iobase1 + ATA_CB_STAT);
- if ( !(status & ATA_CB_STAT_BSY) ) break;
- }
-
- if (status & ATA_CB_STAT_ERR) {
- BX_DEBUG_ATA("ata_cmd_packet : error, status is %02x\n",status);
- return 3;
- } else if ( !(status & ATA_CB_STAT_DRQ) ) {
- BX_DEBUG_ATA("ata_cmd_packet : DRQ not set (status %02x)\n", (unsigned) status);
- return 4;
- }
-
- // Normalize address
- cmdseg += (cmdoff / 16);
- cmdoff %= 16;
-
- // Send command to device
-ASM_START
- sti ;; enable higher priority interrupts
-
- push bp
- mov bp, sp
-
- mov si, _ata_cmd_packet.cmdoff + 2[bp]
- mov ax, _ata_cmd_packet.cmdseg + 2[bp]
- mov cx, _ata_cmd_packet.cmdlen + 2[bp]
- mov es, ax ;; segment in es
-
- mov dx, _ata_cmd_packet.iobase1 + 2[bp] ;; ATA data write port
-
- seg ES
- rep
- outsw ;; CX words transfered from port(DX) to ES:[SI]
-
- pop bp
-ASM_END
-
- if (inout == ATA_DATA_NO) {
- status = inb(iobase1 + ATA_CB_STAT);
- }
- else {
- while (1) {
-
- status = inb(iobase1 + ATA_CB_STAT);
-
- // Check if command completed
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_DRQ) ) ==0 ) break;
-
- if (status & ATA_CB_STAT_ERR) {
- BX_DEBUG_ATA("ata_cmd_packet : error (status %02x)\n",status);
- return 3;
- }
-
- // Device must be ready to send data
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR) )
- != (ATA_CB_STAT_RDY | ATA_CB_STAT_DRQ) ) {
- BX_DEBUG_ATA("ata_cmd_packet : not ready (status %02x)\n", status);
- return 4;
- }
-
- // Normalize address
- bufseg += (bufoff / 16);
- bufoff %= 16;
-
- // Get the byte count
- lcount = ((Bit16u)(inb(iobase1 + ATA_CB_CH))<<8)+inb(iobase1 + ATA_CB_CL);
-
- // adjust to read what we want
- if(header>lcount) {
- lbefore=lcount;
- header-=lcount;
- lcount=0;
- }
- else {
- lbefore=header;
- header=0;
- lcount-=lbefore;
- }
-
- if(lcount>length) {
- lafter=lcount-length;
- lcount=length;
- length=0;
- }
- else {
- lafter=0;
- length-=lcount;
- }
-
- // Save byte count
- count = lcount;
-
- BX_DEBUG_ATA("Trying to read %04x bytes (%04x %04x %04x) ",lbefore+lcount+lafter,lbefore,lcount,lafter);
- BX_DEBUG_ATA("to 0x%04x:0x%04x\n",bufseg,bufoff);
-
- // If counts not dividable by 4, use 16bits mode
- lmode = mode;
- if (lbefore & 0x03) lmode=ATA_MODE_PIO16;
- if (lcount & 0x03) lmode=ATA_MODE_PIO16;
- if (lafter & 0x03) lmode=ATA_MODE_PIO16;
-
- // adds an extra byte if count are odd. before is always even
- if (lcount & 0x01) {
- lcount+=1;
- if ((lafter > 0) && (lafter & 0x01)) {
- lafter-=1;
- }
- }
-
- if (lmode == ATA_MODE_PIO32) {
- lcount>>=2; lbefore>>=2; lafter>>=2;
- }
- else {
- lcount>>=1; lbefore>>=1; lafter>>=1;
- }
-
- ; // FIXME bcc bug
-
-ASM_START
- push bp
- mov bp, sp
-
- mov dx, _ata_cmd_packet.iobase1 + 2[bp] ;; ATA data read port
-
- mov cx, _ata_cmd_packet.lbefore + 2[bp]
- jcxz ata_packet_no_before
-
- mov ah, _ata_cmd_packet.lmode + 2[bp]
- cmp ah, #ATA_MODE_PIO32
- je ata_packet_in_before_32
-
-ata_packet_in_before_16:
- in ax, dx
- loop ata_packet_in_before_16
- jmp ata_packet_no_before
-
-ata_packet_in_before_32:
- push eax
-ata_packet_in_before_32_loop:
- in eax, dx
- loop ata_packet_in_before_32_loop
- pop eax
-
-ata_packet_no_before:
- mov cx, _ata_cmd_packet.lcount + 2[bp]
- jcxz ata_packet_after
-
- mov di, _ata_cmd_packet.bufoff + 2[bp]
- mov ax, _ata_cmd_packet.bufseg + 2[bp]
- mov es, ax
-
- mov ah, _ata_cmd_packet.lmode + 2[bp]
- cmp ah, #ATA_MODE_PIO32
- je ata_packet_in_32
-
-ata_packet_in_16:
- rep
- insw ;; CX words transfered tp port(DX) to ES:[DI]
- jmp ata_packet_after
-
-ata_packet_in_32:
- rep
- insd ;; CX dwords transfered to port(DX) to ES:[DI]
-
-ata_packet_after:
- mov cx, _ata_cmd_packet.lafter + 2[bp]
- jcxz ata_packet_done
-
- mov ah, _ata_cmd_packet.lmode + 2[bp]
- cmp ah, #ATA_MODE_PIO32
- je ata_packet_in_after_32
-
-ata_packet_in_after_16:
- in ax, dx
- loop ata_packet_in_after_16
- jmp ata_packet_done
-
-ata_packet_in_after_32:
- push eax
-ata_packet_in_after_32_loop:
- in eax, dx
- loop ata_packet_in_after_32_loop
- pop eax
-
-ata_packet_done:
- pop bp
-ASM_END
-
- // Compute new buffer address
- bufoff += count;
-
- // Save transferred bytes count
- transfer += count;
- write_dword(ebda_seg, &EbdaData->ata.trsfbytes,transfer);
- }
- }
-
- // Final check, device must be ready
- if ( (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_RDY | ATA_CB_STAT_DF | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR) )
- != ATA_CB_STAT_RDY ) {
- BX_DEBUG_ATA("ata_cmd_packet : not ready (status %02x)\n", (unsigned) status);
- return 4;
- }
-
- // Enable interrupts
- outb(iobase2+ATA_CB_DC, ATA_CB_DC_HD15);
- return 0;
-}
-
-// ---------------------------------------------------------------------------
-// End of ATA/ATAPI Driver
-// ---------------------------------------------------------------------------
-
-// ---------------------------------------------------------------------------
-// Start of ATA/ATAPI generic functions
-// ---------------------------------------------------------------------------
-
- Bit16u
-atapi_get_sense(device)
- Bit16u device;
-{
- Bit8u atacmd[12];
- Bit8u buffer[16];
- Bit8u i;
-
- memsetb(get_SS(),atacmd,0,12);
-
- // Request SENSE
- atacmd[0]=0x03;
- atacmd[4]=0x20;
- if (ata_cmd_packet(device, 12, get_SS(), atacmd, 0, 16L, ATA_DATA_IN, get_SS(), buffer) != 0)
- return 0x0002;
-
- if ((buffer[0] & 0x7e) == 0x70) {
- return (((Bit16u)buffer[2]&0x0f)*0x100)+buffer[12];
- }
-
- return 0;
-}
-
- Bit16u
-atapi_is_ready(device)
- Bit16u device;
-{
- Bit8u atacmd[12];
- Bit8u buffer[];
-
- memsetb(get_SS(),atacmd,0,12);
-
- // Test Unit Ready
- if (ata_cmd_packet(device, 12, get_SS(), atacmd, 0, 0L, ATA_DATA_NO, get_SS(), buffer) != 0)
- return 0x000f;
-
- if (atapi_get_sense(device) !=0 ) {
- memsetb(get_SS(),atacmd,0,12);
-
- // try to send Test Unit Ready again
- if (ata_cmd_packet(device, 12, get_SS(), atacmd, 0, 0L, ATA_DATA_NO, get_SS(), buffer) != 0)
- return 0x000f;
-
- return atapi_get_sense(device);
- }
- return 0;
-}
-
- Bit16u
-atapi_is_cdrom(device)
- Bit8u device;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
-
- if (device >= BX_MAX_ATA_DEVICES)
- return 0;
-
- if (read_byte(ebda_seg,&EbdaData->ata.devices[device].type) != ATA_TYPE_ATAPI)
- return 0;
-
- if (read_byte(ebda_seg,&EbdaData->ata.devices[device].device) != ATA_DEVICE_CDROM)
- return 0;
-
- return 1;
-}
-
-// ---------------------------------------------------------------------------
-// End of ATA/ATAPI generic functions
-// ---------------------------------------------------------------------------
-
-#endif // BX_USE_ATADRV
-
-#if BX_ELTORITO_BOOT
-
-// ---------------------------------------------------------------------------
-// Start of El-Torito boot functions
-// ---------------------------------------------------------------------------
-
- void
-cdemu_init()
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
-
- // the only important data is this one for now
- write_byte(ebda_seg,&EbdaData->cdemu.active,0x00);
-}
-
- Bit8u
-cdemu_isactive()
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
-
- return(read_byte(ebda_seg,&EbdaData->cdemu.active));
-}
-
- Bit8u
-cdemu_emulated_drive()
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
-
- return(read_byte(ebda_seg,&EbdaData->cdemu.emulated_drive));
-}
-
-static char isotag[6]="CD001";
-static char eltorito[24]="EL TORITO SPECIFICATION";
-//
-// Returns ah: emulated drive, al: error code
-//
- Bit16u
-cdrom_boot()
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u atacmd[12], buffer[2048];
- Bit32u lba;
- Bit16u boot_segment, nbsectors, i, error;
- Bit8u device;
-
- // Find out the first cdrom
- for (device=0; device<BX_MAX_ATA_DEVICES;device++) {
- if (atapi_is_cdrom(device)) break;
- }
-
- // if not found
- if(device >= BX_MAX_ATA_DEVICES) return 2;
-
- // Read the Boot Record Volume Descriptor
- memsetb(get_SS(),atacmd,0,12);
- atacmd[0]=0x28; // READ command
- atacmd[7]=(0x01 & 0xff00) >> 8; // Sectors
- atacmd[8]=(0x01 & 0x00ff); // Sectors
- atacmd[2]=(0x11 & 0xff000000) >> 24; // LBA
- atacmd[3]=(0x11 & 0x00ff0000) >> 16;
- atacmd[4]=(0x11 & 0x0000ff00) >> 8;
- atacmd[5]=(0x11 & 0x000000ff);
- if((error = ata_cmd_packet(device, 12, get_SS(), atacmd, 0, 2048L, ATA_DATA_IN, get_SS(), buffer)) != 0)
- return 3;
-
- // Validity checks
- if(buffer[0]!=0)return 4;
- for(i=0;i<5;i++){
- if(buffer[1+i]!=read_byte(0xf000,&isotag[i]))return 5;
- }
- for(i=0;i<23;i++)
- if(buffer[7+i]!=read_byte(0xf000,&eltorito[i]))return 6;
-
- // ok, now we calculate the Boot catalog address
- lba=buffer[0x4A]*0x1000000+buffer[0x49]*0x10000+buffer[0x48]*0x100+buffer[0x47];
-
- // And we read the Boot Catalog
- memsetb(get_SS(),atacmd,0,12);
- atacmd[0]=0x28; // READ command
- atacmd[7]=(0x01 & 0xff00) >> 8; // Sectors
- atacmd[8]=(0x01 & 0x00ff); // Sectors
- atacmd[2]=(lba & 0xff000000) >> 24; // LBA
- atacmd[3]=(lba & 0x00ff0000) >> 16;
- atacmd[4]=(lba & 0x0000ff00) >> 8;
- atacmd[5]=(lba & 0x000000ff);
- if((error = ata_cmd_packet(device, 12, get_SS(), atacmd, 0, 2048L, ATA_DATA_IN, get_SS(), buffer)) != 0)
- return 7;
-
- // Validation entry
- if(buffer[0x00]!=0x01)return 8; // Header
- if(buffer[0x01]!=0x00)return 9; // Platform
- if(buffer[0x1E]!=0x55)return 10; // key 1
- if(buffer[0x1F]!=0xAA)return 10; // key 2
-
- // Initial/Default Entry
- if(buffer[0x20]!=0x88)return 11; // Bootable
-
- write_byte(ebda_seg,&EbdaData->cdemu.media,buffer[0x21]);
- if(buffer[0x21]==0){
- // FIXME ElTorito Hardcoded. cdrom is hardcoded as device 0xE0.
- // Win2000 cd boot needs to know it booted from cd
- write_byte(ebda_seg,&EbdaData->cdemu.emulated_drive,0xE0);
- }
- else if(buffer[0x21]<4)
- write_byte(ebda_seg,&EbdaData->cdemu.emulated_drive,0x00);
- else
- write_byte(ebda_seg,&EbdaData->cdemu.emulated_drive,0x80);
-
- write_byte(ebda_seg,&EbdaData->cdemu.controller_index,device/2);
- write_byte(ebda_seg,&EbdaData->cdemu.device_spec,device%2);
-
- boot_segment=buffer[0x23]*0x100+buffer[0x22];
- if(boot_segment==0x0000)boot_segment=0x07C0;
-
- write_word(ebda_seg,&EbdaData->cdemu.load_segment,boot_segment);
- write_word(ebda_seg,&EbdaData->cdemu.buffer_segment,0x0000);
-
- nbsectors=buffer[0x27]*0x100+buffer[0x26];
- write_word(ebda_seg,&EbdaData->cdemu.sector_count,nbsectors);
-
- lba=buffer[0x2B]*0x1000000+buffer[0x2A]*0x10000+buffer[0x29]*0x100+buffer[0x28];
- write_dword(ebda_seg,&EbdaData->cdemu.ilba,lba);
-
- // And we read the image in memory
- memsetb(get_SS(),atacmd,0,12);
- atacmd[0]=0x28; // READ command
- atacmd[7]=((1+(nbsectors-1)/4) & 0xff00) >> 8; // Sectors
- atacmd[8]=((1+(nbsectors-1)/4) & 0x00ff); // Sectors
- atacmd[2]=(lba & 0xff000000) >> 24; // LBA
- atacmd[3]=(lba & 0x00ff0000) >> 16;
- atacmd[4]=(lba & 0x0000ff00) >> 8;
- atacmd[5]=(lba & 0x000000ff);
- if((error = ata_cmd_packet(device, 12, get_SS(), atacmd, 0, nbsectors*512L, ATA_DATA_IN, boot_segment,0)) != 0)
- return 12;
-
- // Remember the media type
- switch(read_byte(ebda_seg,&EbdaData->cdemu.media)) {
- case 0x01: // 1.2M floppy
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.spt,15);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.cylinders,80);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.heads,2);
- break;
- case 0x02: // 1.44M floppy
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.spt,18);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.cylinders,80);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.heads,2);
- break;
- case 0x03: // 2.88M floppy
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.spt,36);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.cylinders,80);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.heads,2);
- break;
- case 0x04: // Harddrive
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.spt,read_byte(boot_segment,446+6)&0x3f);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.cylinders,
- (read_byte(boot_segment,446+6)<<2) + read_byte(boot_segment,446+7) + 1);
- write_word(ebda_seg,&EbdaData->cdemu.vdevice.heads,read_byte(boot_segment,446+5) + 1);
- break;
- }
-
- if(read_byte(ebda_seg,&EbdaData->cdemu.media)!=0) {
- // Increase bios installed hardware number of devices
- if(read_byte(ebda_seg,&EbdaData->cdemu.emulated_drive)==0x00)
- write_byte(0x40,0x10,read_byte(0x40,0x10)|0x41);
- else
- write_byte(ebda_seg, &EbdaData->ata.hdcount, read_byte(ebda_seg, &EbdaData->ata.hdcount) + 1);
- }
-
-
- // everything is ok, so from now on, the emulation is active
- if(read_byte(ebda_seg,&EbdaData->cdemu.media)!=0)
- write_byte(ebda_seg,&EbdaData->cdemu.active,0x01);
-
- // return the boot drive + no error
- return (read_byte(ebda_seg,&EbdaData->cdemu.emulated_drive)*0x100)+0;
-}
-
-// ---------------------------------------------------------------------------
-// End of El-Torito boot functions
-// ---------------------------------------------------------------------------
-#endif // BX_ELTORITO_BOOT
-
- void
-int14_function(regs, ds, iret_addr)
- pusha_regs_t regs; // regs pushed from PUSHA instruction
- Bit16u ds; // previous DS:, DS set to 0x0000 by asm wrapper
- iret_addr_t iret_addr; // CS,IP,Flags pushed from original INT call
-{
- Bit16u addr,timer,val16;
- Bit8u timeout;
-
- ASM_START
- sti
- ASM_END
-
- addr = read_word(0x0040, (regs.u.r16.dx << 1));
- timeout = read_byte(0x0040, 0x007C + regs.u.r16.dx);
- if ((regs.u.r16.dx < 4) && (addr > 0)) {
- switch (regs.u.r8.ah) {
- case 0:
- outb(addr+3, inb(addr+3) | 0x80);
- if (regs.u.r8.al & 0xE0 == 0) {
- outb(addr, 0x17);
- outb(addr+1, 0x04);
- } else {
- val16 = 0x600 >> ((regs.u.r8.al & 0xE0) >> 5);
- outb(addr, val16 & 0xFF);
- outb(addr+1, val16 >> 8);
- }
- outb(addr+3, regs.u.r8.al & 0x1F);
- regs.u.r8.ah = inb(addr+5);
- regs.u.r8.al = inb(addr+6);
- ClearCF(iret_addr.flags);
- break;
- case 1:
- timer = read_word(0x0040, 0x006C);
- while (((inb(addr+5) & 0x60) != 0x60) && (timeout)) {
- val16 = read_word(0x0040, 0x006C);
- if (val16 != timer) {
- timer = val16;
- timeout--;
- }
- }
- if (timeout) outb(addr, regs.u.r8.al);
- regs.u.r8.ah = inb(addr+5);
- if (!timeout) regs.u.r8.ah |= 0x80;
- ClearCF(iret_addr.flags);
- break;
- case 2:
- timer = read_word(0x0040, 0x006C);
- while (((inb(addr+5) & 0x01) == 0) && (timeout)) {
- val16 = read_word(0x0040, 0x006C);
- if (val16 != timer) {
- timer = val16;
- timeout--;
- }
- }
- if (timeout) {
- regs.u.r8.ah = 0;
- regs.u.r8.al = inb(addr);
- } else {
- regs.u.r8.ah = inb(addr+5);
- }
- ClearCF(iret_addr.flags);
- break;
- case 3:
- regs.u.r8.ah = inb(addr+5);
- regs.u.r8.al = inb(addr+6);
- ClearCF(iret_addr.flags);
- break;
- default:
- SetCF(iret_addr.flags); // Unsupported
- }
- } else {
- SetCF(iret_addr.flags); // Unsupported
- }
-}
-
- void
-int15_function(regs, ES, DS, FLAGS)
- pusha_regs_t regs; // REGS pushed via pusha
- Bit16u ES, DS, FLAGS;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- bx_bool prev_a20_enable;
- Bit16u base15_00;
- Bit8u base23_16;
- Bit16u ss;
- Bit16u CX,DX;
-
- Bit16u bRegister;
- Bit8u irqDisable;
-
-BX_DEBUG_INT15("int15 AX=%04x\n",regs.u.r16.ax);
-
- switch (regs.u.r8.ah) {
- case 0x24: /* A20 Control */
- switch (regs.u.r8.al) {
- case 0x00:
- set_enable_a20(0);
- CLEAR_CF();
- regs.u.r8.ah = 0;
- break;
- case 0x01:
- set_enable_a20(1);
- CLEAR_CF();
- regs.u.r8.ah = 0;
- break;
- case 0x02:
- regs.u.r8.al = (inb(0x92) >> 1) & 0x01;
- CLEAR_CF();
- regs.u.r8.ah = 0;
- break;
- case 0x03:
- CLEAR_CF();
- regs.u.r8.ah = 0;
- regs.u.r16.bx = 3;
- break;
- default:
- BX_INFO("int15: Func 24h, subfunc %02xh, A20 gate control not supported\n", (unsigned) regs.u.r8.al);
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- }
- break;
-
- case 0x41:
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
-
- case 0x4f:
- /* keyboard intercept */
-#if BX_CPU < 2
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
-#else
- // nop
-#endif
- SET_CF();
- break;
-
- case 0x52: // removable media eject
- CLEAR_CF();
- regs.u.r8.ah = 0; // "ok ejection may proceed"
- break;
-
- case 0x83: {
- if( regs.u.r8.al == 0 ) {
- // Set Interval requested.
- if( ( read_byte( 0x40, 0xA0 ) & 1 ) == 0 ) {
- // Interval not already set.
- write_byte( 0x40, 0xA0, 1 ); // Set status byte.
- write_word( 0x40, 0x98, ES ); // Byte location, segment
- write_word( 0x40, 0x9A, regs.u.r16.bx ); // Byte location, offset
- write_word( 0x40, 0x9C, regs.u.r16.dx ); // Low word, delay
- write_word( 0x40, 0x9E, regs.u.r16.cx ); // High word, delay.
- CLEAR_CF( );
- irqDisable = inb( 0xA1 );
- outb( 0xA1, irqDisable & 0xFE );
- bRegister = inb_cmos( 0xB ); // Unmask IRQ8 so INT70 will get through.
- outb_cmos( 0xB, bRegister | 0x40 ); // Turn on the Periodic Interrupt timer
- } else {
- // Interval already set.
- BX_DEBUG_INT15("int15: Func 83h, failed, already waiting.\n" );
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- }
- } else if( regs.u.r8.al == 1 ) {
- // Clear Interval requested
- write_byte( 0x40, 0xA0, 0 ); // Clear status byte
- CLEAR_CF( );
- bRegister = inb_cmos( 0xB );
- outb_cmos( 0xB, bRegister & ~0x40 ); // Turn off the Periodic Interrupt timer
- } else {
- BX_DEBUG_INT15("int15: Func 83h, failed.\n" );
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- regs.u.r8.al--;
- }
-
- break;
- }
-
- case 0x87:
-#if BX_CPU < 3
-# error "Int15 function 87h not supported on < 80386"
-#endif
- // +++ should probably have descriptor checks
- // +++ should have exception handlers
-
- // turn off interrupts
-ASM_START
- cli
-ASM_END
-
- prev_a20_enable = set_enable_a20(1); // enable A20 line
-
- // 128K max of transfer on 386+ ???
- // source == destination ???
-
- // ES:SI points to descriptor table
- // offset use initially comments
- // ==============================================
- // 00..07 Unused zeros Null descriptor
- // 08..0f GDT zeros filled in by BIOS
- // 10..17 source ssssssss source of data
- // 18..1f dest dddddddd destination of data
- // 20..27 CS zeros filled in by BIOS
- // 28..2f SS zeros filled in by BIOS
-
- //es:si
- //eeee0
- //0ssss
- //-----
-
-// check for access rights of source & dest here
-
- // Initialize GDT descriptor
- base15_00 = (ES << 4) + regs.u.r16.si;
- base23_16 = ES >> 12;
- if (base15_00 < (ES<<4))
- base23_16++;
- write_word(ES, regs.u.r16.si+0x08+0, 47); // limit 15:00 = 6 * 8bytes/descriptor
- write_word(ES, regs.u.r16.si+0x08+2, base15_00);// base 15:00
- write_byte(ES, regs.u.r16.si+0x08+4, base23_16);// base 23:16
- write_byte(ES, regs.u.r16.si+0x08+5, 0x93); // access
- write_word(ES, regs.u.r16.si+0x08+6, 0x0000); // base 31:24/reserved/limit 19:16
-
- // Initialize CS descriptor
- write_word(ES, regs.u.r16.si+0x20+0, 0xffff);// limit 15:00 = normal 64K limit
- write_word(ES, regs.u.r16.si+0x20+2, 0x0000);// base 15:00
- write_byte(ES, regs.u.r16.si+0x20+4, 0x000f);// base 23:16
- write_byte(ES, regs.u.r16.si+0x20+5, 0x9b); // access
- write_word(ES, regs.u.r16.si+0x20+6, 0x0000);// base 31:24/reserved/limit 19:16
-
- // Initialize SS descriptor
- ss = get_SS();
- base15_00 = ss << 4;
- base23_16 = ss >> 12;
- write_word(ES, regs.u.r16.si+0x28+0, 0xffff); // limit 15:00 = normal 64K limit
- write_word(ES, regs.u.r16.si+0x28+2, base15_00);// base 15:00
- write_byte(ES, regs.u.r16.si+0x28+4, base23_16);// base 23:16
- write_byte(ES, regs.u.r16.si+0x28+5, 0x93); // access
- write_word(ES, regs.u.r16.si+0x28+6, 0x0000); // base 31:24/reserved/limit 19:16
-
- CX = regs.u.r16.cx;
-ASM_START
- // Compile generates locals offset info relative to SP.
- // Get CX (word count) from stack.
- mov bx, sp
- SEG SS
- mov cx, _int15_function.CX [bx]
-
- // since we need to set SS:SP, save them to the BDA
- // for future restore
- push eax
- xor eax, eax
- mov ds, ax
- mov 0x0469, ss
- mov 0x0467, sp
-
- SEG ES
- lgdt [si + 0x08]
- SEG CS
- lidt [pmode_IDT_info]
- ;; perhaps do something with IDT here
-
- ;; set PE bit in CR0
- mov eax, cr0
- or al, #0x01
- mov cr0, eax
- ;; far jump to flush CPU queue after transition to protected mode
- JMP_AP(0x0020, protected_mode)
-
-protected_mode:
- ;; GDT points to valid descriptor table, now load SS, DS, ES
- mov ax, #0x28 ;; 101 000 = 5th descriptor in table, TI=GDT, RPL=00
- mov ss, ax
- mov ax, #0x10 ;; 010 000 = 2nd descriptor in table, TI=GDT, RPL=00
- mov ds, ax
- mov ax, #0x18 ;; 011 000 = 3rd descriptor in table, TI=GDT, RPL=00
- mov es, ax
- xor si, si
- xor di, di
- cld
- rep
- movsw ;; move CX words from DS:SI to ES:DI
-
- ;; make sure DS and ES limits are 64KB
- mov ax, #0x28
- mov ds, ax
- mov es, ax
-
- ;; reset PG bit in CR0 ???
- mov eax, cr0
- and al, #0xFE
- mov cr0, eax
-
- ;; far jump to flush CPU queue after transition to real mode
- JMP_AP(0xf000, real_mode)
-
-real_mode:
- ;; restore IDT to normal real-mode defaults
- SEG CS
- lidt [rmode_IDT_info]
-
- // restore SS:SP from the BDA
- xor ax, ax
- mov ds, ax
- mov ss, 0x0469
- mov sp, 0x0467
- pop eax
-ASM_END
-
- set_enable_a20(prev_a20_enable);
-
- // turn back on interrupts
-ASM_START
- sti
-ASM_END
-
- regs.u.r8.ah = 0;
- CLEAR_CF();
- break;
-
-
- case 0x88:
- // Get the amount of extended memory (above 1M)
-#if BX_CPU < 2
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- SET_CF();
-#else
- regs.u.r8.al = inb_cmos(0x30);
- regs.u.r8.ah = inb_cmos(0x31);
-
- // limit to 15M
- if(regs.u.r16.ax > 0x3c00)
- regs.u.r16.ax = 0x3c00;
-
- CLEAR_CF();
-#endif
- break;
-
- case 0x90:
- /* Device busy interrupt. Called by Int 16h when no key available */
- break;
-
- case 0x91:
- /* Interrupt complete. Called by Int 16h when key becomes available */
- break;
-
- case 0xbf:
- BX_INFO("*** int 15h function AH=bf not yet supported!\n");
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
-
- case 0xC0:
-#if 0
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
-#endif
- CLEAR_CF();
- regs.u.r8.ah = 0;
- regs.u.r16.bx = BIOS_CONFIG_TABLE;
- ES = 0xF000;
- break;
-
- case 0xc1:
- ES = ebda_seg;
- CLEAR_CF();
- break;
-
- case 0xd8:
- bios_printf(BIOS_PRINTF_DEBUG, "EISA BIOS not present\n");
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
-
- default:
- BX_INFO("*** int 15h function AX=%04x, BX=%04x not yet supported!\n",
- (unsigned) regs.u.r16.ax, (unsigned) regs.u.r16.bx);
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
- }
-}
-
-#if BX_USE_PS2_MOUSE
- void
-int15_function_mouse(regs, ES, DS, FLAGS)
- pusha_regs_t regs; // REGS pushed via pusha
- Bit16u ES, DS, FLAGS;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u mouse_flags_1, mouse_flags_2;
- Bit16u mouse_driver_seg;
- Bit16u mouse_driver_offset;
- Bit8u comm_byte, prev_command_byte;
- Bit8u ret, mouse_data1, mouse_data2, mouse_data3;
-
-BX_DEBUG_INT15("int15 AX=%04x\n",regs.u.r16.ax);
-
- switch (regs.u.r8.ah) {
- case 0xC2:
- // Return Codes status in AH
- // =========================
- // 00: success
- // 01: invalid subfunction (AL > 7)
- // 02: invalid input value (out of allowable range)
- // 03: interface error
- // 04: resend command received from mouse controller,
- // device driver should attempt command again
- // 05: cannot enable mouse, since no far call has been installed
- // 80/86: mouse service not implemented
-
- switch (regs.u.r8.al) {
- case 0: // Disable/Enable Mouse
-BX_DEBUG_INT15("case 0:\n");
- switch (regs.u.r8.bh) {
- case 0: // Disable Mouse
-BX_DEBUG_INT15("case 0: disable mouse\n");
- inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- ret = send_to_mouse_ctrl(0xF5); // disable mouse command
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data1);
- if ( (ret == 0) || (mouse_data1 == 0xFA) ) {
- CLEAR_CF();
- regs.u.r8.ah = 0;
- return;
- }
- }
-
- // error
- SET_CF();
- regs.u.r8.ah = ret;
- return;
- break;
-
- case 1: // Enable Mouse
-BX_DEBUG_INT15("case 1: enable mouse\n");
- mouse_flags_2 = read_byte(ebda_seg, 0x0027);
- if ( (mouse_flags_2 & 0x80) == 0 ) {
- BX_DEBUG_INT15("INT 15h C2 Enable Mouse, no far call handler\n");
- SET_CF(); // error
- regs.u.r8.ah = 5; // no far call installed
- return;
- }
- inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- ret = send_to_mouse_ctrl(0xF4); // enable mouse command
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data1);
- if ( (ret == 0) && (mouse_data1 == 0xFA) ) {
- enable_mouse_int_and_events(); // turn IRQ12 and packet generation on
- CLEAR_CF();
- regs.u.r8.ah = 0;
- return;
- }
- }
- SET_CF();
- regs.u.r8.ah = ret;
- return;
-
- default: // invalid subfunction
- BX_DEBUG_INT15("INT 15h C2 AL=0, BH=%02x\n", (unsigned) regs.u.r8.bh);
- SET_CF(); // error
- regs.u.r8.ah = 1; // invalid subfunction
- return;
- }
- break;
-
- case 1: // Reset Mouse
- case 5: // Initialize Mouse
-BX_DEBUG_INT15("case 1 or 5:\n");
- if (regs.u.r8.al == 5) {
- if (regs.u.r8.bh != 3) {
- SET_CF();
- regs.u.r8.ah = 0x02; // invalid input
- return;
- }
- mouse_flags_2 = read_byte(ebda_seg, 0x0027);
- mouse_flags_2 = (mouse_flags_2 & 0x00) | regs.u.r8.bh;
- mouse_flags_1 = 0x00;
- write_byte(ebda_seg, 0x0026, mouse_flags_1);
- write_byte(ebda_seg, 0x0027, mouse_flags_2);
- }
-
- inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- ret = send_to_mouse_ctrl(0xFF); // reset mouse command
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data3);
- // if no mouse attached, it will return RESEND
- if (mouse_data3 == 0xfe) {
- SET_CF();
- return;
- }
- if (mouse_data3 != 0xfa)
- BX_PANIC("Mouse reset returned %02x (should be ack)\n", (unsigned)mouse_data3);
- if ( ret == 0 ) {
- ret = get_mouse_data(&mouse_data1);
- if ( ret == 0 ) {
- ret = get_mouse_data(&mouse_data2);
- if ( ret == 0 ) {
- // turn IRQ12 and packet generation on
- enable_mouse_int_and_events();
- CLEAR_CF();
- regs.u.r8.ah = 0;
- regs.u.r8.bl = mouse_data1;
- regs.u.r8.bh = mouse_data2;
- return;
- }
- }
- }
- }
-
- // error
- SET_CF();
- regs.u.r8.ah = ret;
- return;
-
- case 2: // Set Sample Rate
-BX_DEBUG_INT15("case 2:\n");
- switch (regs.u.r8.bh) {
- case 0: mouse_data1 = 10; break; // 10 reports/sec
- case 1: mouse_data1 = 20; break; // 20 reports/sec
- case 2: mouse_data1 = 40; break; // 40 reports/sec
- case 3: mouse_data1 = 60; break; // 60 reports/sec
- case 4: mouse_data1 = 80; break; // 80 reports/sec
- case 5: mouse_data1 = 100; break; // 100 reports/sec (default)
- case 6: mouse_data1 = 200; break; // 200 reports/sec
- default: mouse_data1 = 0;
- }
- if (mouse_data1 > 0) {
- ret = send_to_mouse_ctrl(0xF3); // set sample rate command
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data2);
- ret = send_to_mouse_ctrl(mouse_data1);
- ret = get_mouse_data(&mouse_data2);
- CLEAR_CF();
- regs.u.r8.ah = 0;
- } else {
- // error
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- }
- } else {
- // error
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- }
- break;
-
- case 3: // Set Resolution
-BX_DEBUG_INT15("case 3:\n");
- // BX:
- // 0 = 25 dpi, 1 count per millimeter
- // 1 = 50 dpi, 2 counts per millimeter
- // 2 = 100 dpi, 4 counts per millimeter
- // 3 = 200 dpi, 8 counts per millimeter
- CLEAR_CF();
- regs.u.r8.ah = 0;
- break;
-
- case 4: // Get Device ID
-BX_DEBUG_INT15("case 4:\n");
- inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- ret = send_to_mouse_ctrl(0xF2); // get mouse ID command
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data1);
- ret = get_mouse_data(&mouse_data2);
- CLEAR_CF();
- regs.u.r8.ah = 0;
- regs.u.r8.bh = mouse_data2;
- } else {
- // error
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- }
- break;
-
- case 6: // Return Status & Set Scaling Factor...
-BX_DEBUG_INT15("case 6:\n");
- switch (regs.u.r8.bh) {
- case 0: // Return Status
- comm_byte = inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- ret = send_to_mouse_ctrl(0xE9); // get mouse info command
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data1);
- if (mouse_data1 != 0xfa)
- BX_PANIC("Mouse status returned %02x (should be ack)\n", (unsigned)mouse_data1);
- if (ret == 0) {
- ret = get_mouse_data(&mouse_data1);
- if ( ret == 0 ) {
- ret = get_mouse_data(&mouse_data2);
- if ( ret == 0 ) {
- ret = get_mouse_data(&mouse_data3);
- if ( ret == 0 ) {
- CLEAR_CF();
- regs.u.r8.ah = 0;
- regs.u.r8.bl = mouse_data1;
- regs.u.r8.cl = mouse_data2;
- regs.u.r8.dl = mouse_data3;
- set_kbd_command_byte(comm_byte); // restore IRQ12 and serial enable
- return;
- }
- }
- }
- }
- }
-
- // error
- SET_CF();
- regs.u.r8.ah = ret;
- set_kbd_command_byte(comm_byte); // restore IRQ12 and serial enable
- return;
-
- case 1: // Set Scaling Factor to 1:1
- case 2: // Set Scaling Factor to 2:1
- comm_byte = inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- if (regs.u.r8.bh == 1) {
- ret = send_to_mouse_ctrl(0xE6);
- } else {
- ret = send_to_mouse_ctrl(0xE7);
- }
- if (ret == 0) {
- get_mouse_data(&mouse_data1);
- ret = (mouse_data1 != 0xFA);
- }
- if (ret == 0) {
- CLEAR_CF();
- regs.u.r8.ah = 0;
- } else {
- // error
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- }
- set_kbd_command_byte(comm_byte); // restore IRQ12 and serial enable
- break;
-
- default:
- BX_PANIC("INT 15h C2 AL=6, BH=%02x\n", (unsigned) regs.u.r8.bh);
- }
- break;
-
- case 7: // Set Mouse Handler Address
-BX_DEBUG_INT15("case 7:\n");
- mouse_driver_seg = ES;
- mouse_driver_offset = regs.u.r16.bx;
- write_word(ebda_seg, 0x0022, mouse_driver_offset);
- write_word(ebda_seg, 0x0024, mouse_driver_seg);
- mouse_flags_2 = read_byte(ebda_seg, 0x0027);
- if (mouse_driver_offset == 0 && mouse_driver_seg == 0) {
- /* remove handler */
- if ( (mouse_flags_2 & 0x80) != 0 ) {
- mouse_flags_2 &= ~0x80;
- inhibit_mouse_int_and_events(); // disable IRQ12 and packets
- }
- }
- else {
- /* install handler */
- mouse_flags_2 |= 0x80;
- }
- write_byte(ebda_seg, 0x0027, mouse_flags_2);
- CLEAR_CF();
- regs.u.r8.ah = 0;
- break;
-
- default:
-BX_DEBUG_INT15("case default:\n");
- regs.u.r8.ah = 1; // invalid function
- SET_CF();
- }
- break;
-
- default:
- BX_INFO("*** int 15h function AX=%04x, BX=%04x not yet supported!\n",
- (unsigned) regs.u.r16.ax, (unsigned) regs.u.r16.bx);
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
- }
-}
-#endif
-
-
-void set_e820_range(ES, DI, start, end, type)
- Bit16u ES;
- Bit16u DI;
- Bit32u start;
- Bit32u end;
- Bit16u type;
-{
- write_word(ES, DI, start);
- write_word(ES, DI+2, start >> 16);
- write_word(ES, DI+4, 0x00);
- write_word(ES, DI+6, 0x00);
-
- end -= start;
- write_word(ES, DI+8, end);
- write_word(ES, DI+10, end >> 16);
- write_word(ES, DI+12, 0x0000);
- write_word(ES, DI+14, 0x0000);
-
- write_word(ES, DI+16, type);
- write_word(ES, DI+18, 0x0);
-}
-
- void
-int15_function32(regs, ES, DS, FLAGS)
- pushad_regs_t regs; // REGS pushed via pushad
- Bit16u ES, DS, FLAGS;
-{
- Bit32u extended_memory_size=0; // 64bits long
- Bit16u CX,DX;
-
-BX_DEBUG_INT15("int15 AX=%04x\n",regs.u.r16.ax);
-
- switch (regs.u.r8.ah) {
- case 0x86:
- // Wait for CX:DX microseconds. currently using the
- // refresh request port 0x61 bit4, toggling every 15usec
-
- CX = regs.u.r16.cx;
- DX = regs.u.r16.dx;
-
-ASM_START
- sti
-
- ;; Get the count in eax
- mov bx, sp
- SEG SS
- mov ax, _int15_function.CX [bx]
- shl eax, #16
- SEG SS
- mov ax, _int15_function.DX [bx]
-
- ;; convert to numbers of 15usec ticks
- mov ebx, #15
- xor edx, edx
- div eax, ebx
- mov ecx, eax
-
- ;; wait for ecx number of refresh requests
- in al, #0x61
- and al,#0x10
- mov ah, al
-
- or ecx, ecx
- je int1586_tick_end
-int1586_tick:
- in al, #0x61
- and al,#0x10
- cmp al, ah
- je int1586_tick
- mov ah, al
- dec ecx
- jnz int1586_tick
-int1586_tick_end:
-ASM_END
-
- break;
-
- case 0xe8:
- switch(regs.u.r8.al)
- {
- case 0x20: // coded by osmaker aka K.J.
- if(regs.u.r32.edx == 0x534D4150)
- {
- switch(regs.u.r16.bx)
- {
- case 0:
- set_e820_range(ES, regs.u.r16.di,
- 0x0000000L, 0x0009fc00L, 1);
- regs.u.r32.ebx = 1;
- regs.u.r32.eax = 0x534D4150;
- regs.u.r32.ecx = 0x14;
- CLEAR_CF();
- return;
- break;
- case 1:
- set_e820_range(ES, regs.u.r16.di,
- 0x0009fc00L, 0x000a0000L, 2);
- regs.u.r32.ebx = 2;
- regs.u.r32.eax = 0x534D4150;
- regs.u.r32.ecx = 0x14;
- CLEAR_CF();
- return;
- break;
- case 2:
- set_e820_range(ES, regs.u.r16.di,
- 0x000e8000L, 0x00100000L, 2);
- regs.u.r32.ebx = 3;
- regs.u.r32.eax = 0x534D4150;
- regs.u.r32.ecx = 0x14;
- CLEAR_CF();
- return;
- break;
- case 3:
- extended_memory_size = inb_cmos(0x35);
- extended_memory_size <<= 8;
- extended_memory_size |= inb_cmos(0x34);
- extended_memory_size *= 64;
- if(extended_memory_size > 0x3bc000) // greater than EFF00000???
- {
- extended_memory_size = 0x3bc000; // everything after this is reserved memory until we get to 0x100000000
- }
- extended_memory_size *= 1024;
- extended_memory_size += (16L * 1024 * 1024);
-
- if(extended_memory_size <= (16L * 1024 * 1024))
- {
- extended_memory_size = inb_cmos(0x31);
- extended_memory_size <<= 8;
- extended_memory_size |= inb_cmos(0x30);
- extended_memory_size *= 1024;
- }
-
- set_e820_range(ES, regs.u.r16.di,
- 0x00100000L, extended_memory_size, 1);
- regs.u.r32.ebx = 4;
- regs.u.r32.eax = 0x534D4150;
- regs.u.r32.ecx = 0x14;
- CLEAR_CF();
- return;
- break;
- case 4:
- /* 256KB BIOS area at the end of 4 GB */
- set_e820_range(ES, regs.u.r16.di,
- 0xfffc0000L, 0x00000000L, 2);
- regs.u.r32.ebx = 0;
- regs.u.r32.eax = 0x534D4150;
- regs.u.r32.ecx = 0x14;
- CLEAR_CF();
- return;
- default: /* AX=E820, DX=534D4150, BX unrecognized */
- goto int15_unimplemented;
- break;
- }
- } else {
- // if DX != 0x534D4150)
- goto int15_unimplemented;
- }
- break;
-
- case 0x01:
- // do we have any reason to fail here ?
- CLEAR_CF();
-
- // my real system sets ax and bx to 0
- // this is confirmed by Ralph Brown list
- // but syslinux v1.48 is known to behave
- // strangely if ax is set to 0
- // regs.u.r16.ax = 0;
- // regs.u.r16.bx = 0;
-
- // Get the amount of extended memory (above 1M)
- regs.u.r8.cl = inb_cmos(0x30);
- regs.u.r8.ch = inb_cmos(0x31);
-
- // limit to 15M
- if(regs.u.r16.cx > 0x3c00)
- {
- regs.u.r16.cx = 0x3c00;
- }
-
- // Get the amount of extended memory above 16M in 64k blocs
- regs.u.r8.dl = inb_cmos(0x34);
- regs.u.r8.dh = inb_cmos(0x35);
-
- // Set configured memory equal to extended memory
- regs.u.r16.ax = regs.u.r16.cx;
- regs.u.r16.bx = regs.u.r16.dx;
- break;
- default: /* AH=0xE8?? but not implemented */
- goto int15_unimplemented;
- }
- break;
- int15_unimplemented:
- // fall into the default
- default:
- BX_INFO("*** int 15h function AX=%04x, BX=%04x not yet supported!\n",
- (unsigned) regs.u.r16.ax, (unsigned) regs.u.r16.bx);
- SET_CF();
- regs.u.r8.ah = UNSUPPORTED_FUNCTION;
- break;
- }
-}
-
- void
-int16_function(DI, SI, BP, SP, BX, DX, CX, AX, FLAGS)
- Bit16u DI, SI, BP, SP, BX, DX, CX, AX, FLAGS;
-{
- Bit8u scan_code, ascii_code, shift_flags, count;
- Bit16u kbd_code, max;
-
- BX_DEBUG_INT16("int16: AX=%04x BX=%04x CX=%04x DX=%04x \n", AX, BX, CX, DX);
-
- switch (GET_AH()) {
- case 0x00: /* read keyboard input */
-
- if ( !dequeue_key(&scan_code, &ascii_code, 1) ) {
- BX_PANIC("KBD: int16h: out of keyboard input\n");
- }
- if (scan_code !=0 && ascii_code == 0xF0) ascii_code = 0;
- else if (ascii_code == 0xE0) ascii_code = 0;
- AX = (scan_code << 8) | ascii_code;
- break;
-
- case 0x01: /* check keyboard status */
- if ( !dequeue_key(&scan_code, &ascii_code, 0) ) {
- SET_ZF();
- return;
- }
- if (scan_code !=0 && ascii_code == 0xF0) ascii_code = 0;
- else if (ascii_code == 0xE0) ascii_code = 0;
- AX = (scan_code << 8) | ascii_code;
- CLEAR_ZF();
- break;
-
- case 0x02: /* get shift flag status */
- shift_flags = read_byte(0x0040, 0x17);
- SET_AL(shift_flags);
- break;
-
- case 0x05: /* store key-stroke into buffer */
- if ( !enqueue_key(GET_CH(), GET_CL()) ) {
- SET_AL(1);
- }
- else {
- SET_AL(0);
- }
- break;
-
- case 0x09: /* GET KEYBOARD FUNCTIONALITY */
- // bit Bochs Description
- // 7 0 reserved
- // 6 0 INT 16/AH=20h-22h supported (122-key keyboard support)
- // 5 1 INT 16/AH=10h-12h supported (enhanced keyboard support)
- // 4 1 INT 16/AH=0Ah supported
- // 3 0 INT 16/AX=0306h supported
- // 2 0 INT 16/AX=0305h supported
- // 1 0 INT 16/AX=0304h supported
- // 0 0 INT 16/AX=0300h supported
- //
- SET_AL(0x30);
- break;
-
- case 0x0A: /* GET KEYBOARD ID */
- count = 2;
- kbd_code = 0x0;
- outb(0x60, 0xf2);
- /* Wait for data */
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x00);
- if (max>0x0) {
- if ((inb(0x60) == 0xfa)) {
- do {
- max=0xffff;
- while ( ((inb(0x64) & 0x01) == 0) && (--max>0) ) outb(0x80, 0x00);
- if (max>0x0) {
- kbd_code >>= 8;
- kbd_code |= (inb(0x60) << 8);
- }
- } while (--count>0);
- }
- }
- BX=kbd_code;
- break;
-
- case 0x10: /* read MF-II keyboard input */
-
- if ( !dequeue_key(&scan_code, &ascii_code, 1) ) {
- BX_PANIC("KBD: int16h: out of keyboard input\n");
- }
- if (scan_code !=0 && ascii_code == 0xF0) ascii_code = 0;
- AX = (scan_code << 8) | ascii_code;
- break;
-
- case 0x11: /* check MF-II keyboard status */
- if ( !dequeue_key(&scan_code, &ascii_code, 0) ) {
- SET_ZF();
- return;
- }
- if (scan_code !=0 && ascii_code == 0xF0) ascii_code = 0;
- AX = (scan_code << 8) | ascii_code;
- CLEAR_ZF();
- break;
-
- case 0x12: /* get extended keyboard status */
- shift_flags = read_byte(0x0040, 0x17);
- SET_AL(shift_flags);
- shift_flags = read_byte(0x0040, 0x18) & 0x73;
- shift_flags |= read_byte(0x0040, 0x96) & 0x0c;
- SET_AH(shift_flags);
- BX_DEBUG_INT16("int16: func 12 sending %04x\n",AX);
- break;
-
- case 0x92: /* keyboard capability check called by DOS 5.0+ keyb */
- SET_AH(0x80); // function int16 ah=0x10-0x12 supported
- break;
-
- case 0xA2: /* 122 keys capability check called by DOS 5.0+ keyb */
- // don't change AH : function int16 ah=0x20-0x22 NOT supported
- break;
-
- case 0x6F:
- if (GET_AL() == 0x08)
- SET_AH(0x02); // unsupported, aka normal keyboard
-
- default:
- BX_INFO("KBD: unsupported int 16h function %02x\n", GET_AH());
- }
-}
-
- unsigned int
-dequeue_key(scan_code, ascii_code, incr)
- Bit8u *scan_code;
- Bit8u *ascii_code;
- unsigned int incr;
-{
- Bit16u buffer_start, buffer_end, buffer_head, buffer_tail;
- Bit16u ss;
- Bit8u acode, scode;
-
-#if BX_CPU < 2
- buffer_start = 0x001E;
- buffer_end = 0x003E;
-#else
- buffer_start = read_word(0x0040, 0x0080);
- buffer_end = read_word(0x0040, 0x0082);
-#endif
-
- buffer_head = read_word(0x0040, 0x001a);
- buffer_tail = read_word(0x0040, 0x001c);
-
- if (buffer_head != buffer_tail) {
- ss = get_SS();
- acode = read_byte(0x0040, buffer_head);
- scode = read_byte(0x0040, buffer_head+1);
- write_byte(ss, ascii_code, acode);
- write_byte(ss, scan_code, scode);
-
- if (incr) {
- buffer_head += 2;
- if (buffer_head >= buffer_end)
- buffer_head = buffer_start;
- write_word(0x0040, 0x001a, buffer_head);
- }
- return(1);
- }
- else {
- return(0);
- }
-}
-
-static char panic_msg_keyb_buffer_full[] = "%s: keyboard input buffer full\n";
-
- Bit8u
-inhibit_mouse_int_and_events()
-{
- Bit8u command_byte, prev_command_byte;
-
- // Turn off IRQ generation and aux data line
- if ( inb(0x64) & 0x02 )
- BX_PANIC(panic_msg_keyb_buffer_full,"inhibmouse");
- outb(0x64, 0x20); // get command byte
- while ( (inb(0x64) & 0x01) != 0x01 );
- prev_command_byte = inb(0x60);
- command_byte = prev_command_byte;
- //while ( (inb(0x64) & 0x02) );
- if ( inb(0x64) & 0x02 )
- BX_PANIC(panic_msg_keyb_buffer_full,"inhibmouse");
- command_byte &= 0xfd; // turn off IRQ 12 generation
- command_byte |= 0x20; // disable mouse serial clock line
- outb(0x64, 0x60); // write command byte
- outb(0x60, command_byte);
- return(prev_command_byte);
-}
-
- void
-enable_mouse_int_and_events()
-{
- Bit8u command_byte;
-
- // Turn on IRQ generation and aux data line
- if ( inb(0x64) & 0x02 )
- BX_PANIC(panic_msg_keyb_buffer_full,"enabmouse");
- outb(0x64, 0x20); // get command byte
- while ( (inb(0x64) & 0x01) != 0x01 );
- command_byte = inb(0x60);
- //while ( (inb(0x64) & 0x02) );
- if ( inb(0x64) & 0x02 )
- BX_PANIC(panic_msg_keyb_buffer_full,"enabmouse");
- command_byte |= 0x02; // turn on IRQ 12 generation
- command_byte &= 0xdf; // enable mouse serial clock line
- outb(0x64, 0x60); // write command byte
- outb(0x60, command_byte);
-}
-
- Bit8u
-send_to_mouse_ctrl(sendbyte)
- Bit8u sendbyte;
-{
- Bit8u response;
-
- // wait for chance to write to ctrl
- if ( inb(0x64) & 0x02 )
- BX_PANIC(panic_msg_keyb_buffer_full,"sendmouse");
- outb(0x64, 0xD4);
- outb(0x60, sendbyte);
- return(0);
-}
-
-
- Bit8u
-get_mouse_data(data)
- Bit8u *data;
-{
- Bit8u response;
- Bit16u ss;
-
- while ( (inb(0x64) & 0x21) != 0x21 ) {
- }
-
- response = inb(0x60);
-
- ss = get_SS();
- write_byte(ss, data, response);
- return(0);
-}
-
- void
-set_kbd_command_byte(command_byte)
- Bit8u command_byte;
-{
- if ( inb(0x64) & 0x02 )
- BX_PANIC(panic_msg_keyb_buffer_full,"setkbdcomm");
- outb(0x64, 0xD4);
-
- outb(0x64, 0x60); // write command byte
- outb(0x60, command_byte);
-}
-
- void
-int09_function(DI, SI, BP, SP, BX, DX, CX, AX)
- Bit16u DI, SI, BP, SP, BX, DX, CX, AX;
-{
- Bit8u scancode, asciicode, shift_flags;
- Bit8u mf2_flags, mf2_state, led_flags;
-
- //
- // DS has been set to F000 before call
- //
-
-
- scancode = GET_AL();
-
- if (scancode == 0) {
- BX_INFO("KBD: int09 handler: AL=0\n");
- return;
- }
-
-
- shift_flags = read_byte(0x0040, 0x17);
- mf2_flags = read_byte(0x0040, 0x18);
- mf2_state = read_byte(0x0040, 0x96);
- led_flags = read_byte(0x0040, 0x97);
- asciicode = 0;
-
- switch (scancode) {
- case 0x3a: /* Caps Lock press */
- shift_flags ^= 0x40;
- write_byte(0x0040, 0x17, shift_flags);
- mf2_flags |= 0x40;
- led_flags ^= 0x04;
- write_byte(0x0040, 0x18, mf2_flags);
- write_byte(0x0040, 0x97, led_flags);
- break;
- case 0xba: /* Caps Lock release */
- mf2_flags &= ~0x40;
- write_byte(0x0040, 0x18, mf2_flags);
- break;
-
- case 0x2a: /* L Shift press */
- shift_flags |= 0x02;
- write_byte(0x0040, 0x17, shift_flags);
- break;
- case 0xaa: /* L Shift release */
- shift_flags &= ~0x02;
- write_byte(0x0040, 0x17, shift_flags);
- break;
-
- case 0x36: /* R Shift press */
- shift_flags |= 0x01;
- write_byte(0x0040, 0x17, shift_flags);
- break;
- case 0xb6: /* R Shift release */
- shift_flags &= ~0x01;
- write_byte(0x0040, 0x17, shift_flags);
- break;
-
- case 0x1d: /* Ctrl press */
- if ((mf2_state & 0x01) == 0) {
- shift_flags |= 0x04;
- write_byte(0x0040, 0x17, shift_flags);
- if (mf2_state & 0x02) {
- mf2_state |= 0x04;
- write_byte(0x0040, 0x96, mf2_state);
- } else {
- mf2_flags |= 0x01;
- write_byte(0x0040, 0x18, mf2_flags);
- }
- }
- break;
- case 0x9d: /* Ctrl release */
- if ((mf2_state & 0x01) == 0) {
- shift_flags &= ~0x04;
- write_byte(0x0040, 0x17, shift_flags);
- if (mf2_state & 0x02) {
- mf2_state &= ~0x04;
- write_byte(0x0040, 0x96, mf2_state);
- } else {
- mf2_flags &= ~0x01;
- write_byte(0x0040, 0x18, mf2_flags);
- }
- }
- break;
-
- case 0x38: /* Alt press */
- shift_flags |= 0x08;
- write_byte(0x0040, 0x17, shift_flags);
- if (mf2_state & 0x02) {
- mf2_state |= 0x08;
- write_byte(0x0040, 0x96, mf2_state);
- } else {
- mf2_flags |= 0x02;
- write_byte(0x0040, 0x18, mf2_flags);
- }
- break;
- case 0xb8: /* Alt release */
- shift_flags &= ~0x08;
- write_byte(0x0040, 0x17, shift_flags);
- if (mf2_state & 0x02) {
- mf2_state &= ~0x08;
- write_byte(0x0040, 0x96, mf2_state);
- } else {
- mf2_flags &= ~0x02;
- write_byte(0x0040, 0x18, mf2_flags);
- }
- break;
-
- case 0x45: /* Num Lock press */
- if ((mf2_state & 0x03) == 0) {
- mf2_flags |= 0x20;
- write_byte(0x0040, 0x18, mf2_flags);
- shift_flags ^= 0x20;
- led_flags ^= 0x02;
- write_byte(0x0040, 0x17, shift_flags);
- write_byte(0x0040, 0x97, led_flags);
- }
- break;
- case 0xc5: /* Num Lock release */
- if ((mf2_state & 0x03) == 0) {
- mf2_flags &= ~0x20;
- write_byte(0x0040, 0x18, mf2_flags);
- }
- break;
-
- case 0x46: /* Scroll Lock press */
- mf2_flags |= 0x10;
- write_byte(0x0040, 0x18, mf2_flags);
- shift_flags ^= 0x10;
- led_flags ^= 0x01;
- write_byte(0x0040, 0x17, shift_flags);
- write_byte(0x0040, 0x97, led_flags);
- break;
-
- case 0xc6: /* Scroll Lock release */
- mf2_flags &= ~0x10;
- write_byte(0x0040, 0x18, mf2_flags);
- break;
-
- default:
- if (scancode & 0x80) {
- break; /* toss key releases ... */
- }
- if (scancode > MAX_SCAN_CODE) {
- BX_INFO("KBD: int09h_handler(): unknown scancode read: 0x%02x!\n", scancode);
- return;
- }
- if (shift_flags & 0x08) { /* ALT */
- asciicode = scan_to_scanascii[scancode].alt;
- scancode = scan_to_scanascii[scancode].alt >> 8;
- } else if (shift_flags & 0x04) { /* CONTROL */
- asciicode = scan_to_scanascii[scancode].control;
- scancode = scan_to_scanascii[scancode].control >> 8;
- } else if (shift_flags & 0x03) { /* LSHIFT + RSHIFT */
- /* check if lock state should be ignored
- * because a SHIFT key are pressed */
-
- if (shift_flags & scan_to_scanascii[scancode].lock_flags) {
- asciicode = scan_to_scanascii[scancode].normal;
- scancode = scan_to_scanascii[scancode].normal >> 8;
- } else {
- asciicode = scan_to_scanascii[scancode].shift;
- scancode = scan_to_scanascii[scancode].shift >> 8;
- }
- } else {
- /* check if lock is on */
- if (shift_flags & scan_to_scanascii[scancode].lock_flags) {
- asciicode = scan_to_scanascii[scancode].shift;
- scancode = scan_to_scanascii[scancode].shift >> 8;
- } else {
- asciicode = scan_to_scanascii[scancode].normal;
- scancode = scan_to_scanascii[scancode].normal >> 8;
- }
- }
- if (scancode==0 && asciicode==0) {
- BX_INFO("KBD: int09h_handler(): scancode & asciicode are zero?\n");
- }
- enqueue_key(scancode, asciicode);
- break;
- }
- if ((scancode & 0x7f) != 0x1d) {
- mf2_state &= ~0x01;
- }
- mf2_state &= ~0x02;
- write_byte(0x0040, 0x96, mf2_state);
-}
-
- unsigned int
-enqueue_key(scan_code, ascii_code)
- Bit8u scan_code, ascii_code;
-{
- Bit16u buffer_start, buffer_end, buffer_head, buffer_tail, temp_tail;
-
-#if BX_CPU < 2
- buffer_start = 0x001E;
- buffer_end = 0x003E;
-#else
- buffer_start = read_word(0x0040, 0x0080);
- buffer_end = read_word(0x0040, 0x0082);
-#endif
-
- buffer_head = read_word(0x0040, 0x001A);
- buffer_tail = read_word(0x0040, 0x001C);
-
- temp_tail = buffer_tail;
- buffer_tail += 2;
- if (buffer_tail >= buffer_end)
- buffer_tail = buffer_start;
-
- if (buffer_tail == buffer_head) {
- return(0);
- }
-
- write_byte(0x0040, temp_tail, ascii_code);
- write_byte(0x0040, temp_tail+1, scan_code);
- write_word(0x0040, 0x001C, buffer_tail);
- return(1);
-}
-
-
- void
-int74_function(make_farcall, Z, Y, X, status)
- Bit16u make_farcall, Z, Y, X, status;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u in_byte, index, package_count;
- Bit8u mouse_flags_1, mouse_flags_2;
-
-BX_DEBUG_INT74("entering int74_function\n");
- make_farcall = 0;
-
- in_byte = inb(0x64);
- if ( (in_byte & 0x21) != 0x21 ) {
- return;
- }
- in_byte = inb(0x60);
-BX_DEBUG_INT74("int74: read byte %02x\n", in_byte);
-
- mouse_flags_1 = read_byte(ebda_seg, 0x0026);
- mouse_flags_2 = read_byte(ebda_seg, 0x0027);
-
- if ( (mouse_flags_2 & 0x80) != 0x80 ) {
- return;
- }
-
- package_count = mouse_flags_2 & 0x07;
- index = mouse_flags_1 & 0x07;
- write_byte(ebda_seg, 0x28 + index, in_byte);
-
- if ( (index+1) >= package_count ) {
-BX_DEBUG_INT74("int74_function: make_farcall=1\n");
- status = read_byte(ebda_seg, 0x0028 + 0);
- X = read_byte(ebda_seg, 0x0028 + 1);
- Y = read_byte(ebda_seg, 0x0028 + 2);
- Z = 0;
- mouse_flags_1 = 0;
- // check if far call handler installed
- if (mouse_flags_2 & 0x80)
- make_farcall = 1;
- }
- else {
- mouse_flags_1++;
- }
- write_byte(ebda_seg, 0x0026, mouse_flags_1);
-}
-
-#define SET_DISK_RET_STATUS(status) write_byte(0x0040, 0x0074, status)
-
-#if BX_USE_ATADRV
-
- void
-int13_harddisk(DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit32u lba;
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit16u cylinder, head, sector;
- Bit16u segment, offset;
- Bit16u npc, nph, npspt, nlc, nlh, nlspt;
- Bit16u size, count;
- Bit8u device, status;
-
- BX_DEBUG_INT13_HD("int13_harddisk: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", AX, BX, CX, DX, ES);
-
- write_byte(0x0040, 0x008e, 0); // clear completion flag
-
- // basic check : device has to be defined
- if ( (GET_ELDL() < 0x80) || (GET_ELDL() >= 0x80 + BX_MAX_ATA_DEVICES) ) {
- BX_INFO("int13_harddisk: function %02x, ELDL out of range %02x\n", GET_AH(), GET_ELDL());
- goto int13_fail;
- }
-
- // Get the ata channel
- device=read_byte(ebda_seg,&EbdaData->ata.hdidmap[GET_ELDL()-0x80]);
-
- // basic check : device has to be valid
- if (device >= BX_MAX_ATA_DEVICES) {
- BX_INFO("int13_harddisk: function %02x, unmapped device for ELDL=%02x\n", GET_AH(), GET_ELDL());
- goto int13_fail;
- }
-
- switch (GET_AH()) {
-
- case 0x00: /* disk controller reset */
- ata_reset (device);
- goto int13_success;
- break;
-
- case 0x01: /* read disk status */
- status = read_byte(0x0040, 0x0074);
- SET_AH(status);
- SET_DISK_RET_STATUS(0);
- /* set CF if error status read */
- if (status) goto int13_fail_nostatus;
- else goto int13_success_noah;
- break;
-
- case 0x02: // read disk sectors
- case 0x03: // write disk sectors
- case 0x04: // verify disk sectors
-
- count = GET_AL();
- cylinder = GET_CH();
- cylinder |= ( ((Bit16u) GET_CL()) << 2) & 0x300;
- sector = (GET_CL() & 0x3f);
- head = GET_DH();
-
- segment = ES;
- offset = BX;
-
- if ( (count > 128) || (count == 0) ) {
- BX_INFO("int13_harddisk: function %02x, count out of range!\n",GET_AH());
- goto int13_fail;
- }
-
- nlc = read_word(ebda_seg, &EbdaData->ata.devices[device].lchs.cylinders);
- nlh = read_word(ebda_seg, &EbdaData->ata.devices[device].lchs.heads);
- nlspt = read_word(ebda_seg, &EbdaData->ata.devices[device].lchs.spt);
-
- // sanity check on cyl heads, sec
- if( (cylinder >= nlc) || (head >= nlh) || (sector > nlspt )) {
- BX_INFO("int13_harddisk: function %02x, parameters out of range %04x/%04x/%04x!\n", GET_AH(), cylinder, head, sector);
- goto int13_fail;
- }
-
- // FIXME verify
- if ( GET_AH() == 0x04 ) goto int13_success;
-
- nph = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.heads);
- npspt = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.spt);
-
- // if needed, translate lchs to lba, and execute command
- if ( (nph != nlh) || (npspt != nlspt)) {
- lba = ((((Bit32u)cylinder * (Bit32u)nlh) + (Bit32u)head) * (Bit32u)nlspt) + (Bit32u)sector - 1;
- sector = 0; // this forces the command to be lba
- }
-
- if ( GET_AH() == 0x02 )
- status=ata_cmd_data_in(device, ATA_CMD_READ_SECTORS, count, cylinder, head, sector, lba, segment, offset);
- else
- status=ata_cmd_data_out(device, ATA_CMD_WRITE_SECTORS, count, cylinder, head, sector, lba, segment, offset);
-
- // Set nb of sector transferred
- SET_AL(read_word(ebda_seg, &EbdaData->ata.trsfsectors));
-
- if (status != 0) {
- BX_INFO("int13_harddisk: function %02x, error %02x !\n",GET_AH(),status);
- SET_AH(0x0c);
- goto int13_fail_noah;
- }
-
- goto int13_success;
- break;
-
- case 0x05: /* format disk track */
- BX_INFO("format disk track called\n");
- goto int13_success;
- return;
- break;
-
- case 0x08: /* read disk drive parameters */
-
- // Get logical geometry from table
- nlc = read_word(ebda_seg, &EbdaData->ata.devices[device].lchs.cylinders);
- nlh = read_word(ebda_seg, &EbdaData->ata.devices[device].lchs.heads);
- nlspt = read_word(ebda_seg, &EbdaData->ata.devices[device].lchs.spt);
- count = read_byte(ebda_seg, &EbdaData->ata.hdcount);
-
- nlc = nlc - 2; /* 0 based , last sector not used */
- SET_AL(0);
- SET_CH(nlc & 0xff);
- SET_CL(((nlc >> 2) & 0xc0) | (nlspt & 0x3f));
- SET_DH(nlh - 1);
- SET_DL(count); /* FIXME returns 0, 1, or n hard drives */
-
- // FIXME should set ES & DI
-
- goto int13_success;
- break;
-
- case 0x10: /* check drive ready */
- // should look at 40:8E also???
-
- // Read the status from controller
- status = inb(read_word(ebda_seg, &EbdaData->ata.channels[device/2].iobase1) + ATA_CB_STAT);
- if ( (status & ( ATA_CB_STAT_BSY | ATA_CB_STAT_RDY )) == ATA_CB_STAT_RDY ) {
- goto int13_success;
- }
- else {
- SET_AH(0xAA);
- goto int13_fail_noah;
- }
- break;
-
- case 0x15: /* read disk drive size */
-
- // Get physical geometry from table
- npc = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.cylinders);
- nph = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.heads);
- npspt = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.spt);
-
- // Compute sector count seen by int13
- lba = (Bit32u)(npc - 1) * (Bit32u)nph * (Bit32u)npspt;
- CX = lba >> 16;
- DX = lba & 0xffff;
-
- SET_AH(3); // hard disk accessible
- goto int13_success_noah;
- break;
-
- case 0x41: // IBM/MS installation check
- BX=0xaa55; // install check
- SET_AH(0x30); // EDD 3.0
- CX=0x0007; // ext disk access and edd, removable supported
- goto int13_success_noah;
- break;
-
- case 0x42: // IBM/MS extended read
- case 0x43: // IBM/MS extended write
- case 0x44: // IBM/MS verify
- case 0x47: // IBM/MS extended seek
-
- count=read_word(DS, SI+(Bit16u)&Int13Ext->count);
- segment=read_word(DS, SI+(Bit16u)&Int13Ext->segment);
- offset=read_word(DS, SI+(Bit16u)&Int13Ext->offset);
-
- // Can't use 64 bits lba
- lba=read_dword(DS, SI+(Bit16u)&Int13Ext->lba2);
- if (lba != 0L) {
- BX_PANIC("int13_harddisk: function %02x. Can't use 64bits lba\n",GET_AH());
- goto int13_fail;
- }
-
- // Get 32 bits lba and check
- lba=read_dword(DS, SI+(Bit16u)&Int13Ext->lba1);
- if (lba >= read_dword(ebda_seg, &EbdaData->ata.devices[device].sectors) ) {
- BX_INFO("int13_harddisk: function %02x. LBA out of range\n",GET_AH());
- goto int13_fail;
- }
-
- // If verify or seek
- if (( GET_AH() == 0x44 ) || ( GET_AH() == 0x47 ))
- goto int13_success;
-
- // Execute the command
- if ( GET_AH() == 0x42 )
- status=ata_cmd_data_in(device, ATA_CMD_READ_SECTORS, count, 0, 0, 0, lba, segment, offset);
- else
- status=ata_cmd_data_out(device, ATA_CMD_WRITE_SECTORS, count, 0, 0, 0, lba, segment, offset);
-
- count=read_word(ebda_seg, &EbdaData->ata.trsfsectors);
- write_word(DS, SI+(Bit16u)&Int13Ext->count, count);
-
- if (status != 0) {
- BX_INFO("int13_harddisk: function %02x, error %02x !\n",GET_AH(),status);
- SET_AH(0x0c);
- goto int13_fail_noah;
- }
-
- goto int13_success;
- break;
-
- case 0x45: // IBM/MS lock/unlock drive
- case 0x49: // IBM/MS extended media change
- goto int13_success; // Always success for HD
- break;
-
- case 0x46: // IBM/MS eject media
- SET_AH(0xb2); // Volume Not Removable
- goto int13_fail_noah; // Always fail for HD
- break;
-
- case 0x48: // IBM/MS get drive parameters
- size=read_word(DS,SI+(Bit16u)&Int13DPT->size);
-
- // Buffer is too small
- if(size < 0x1a)
- goto int13_fail;
-
- // EDD 1.x
- if(size >= 0x1a) {
- Bit16u blksize;
-
- npc = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.cylinders);
- nph = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.heads);
- npspt = read_word(ebda_seg, &EbdaData->ata.devices[device].pchs.spt);
- lba = read_dword(ebda_seg, &EbdaData->ata.devices[device].sectors);
- blksize = read_word(ebda_seg, &EbdaData->ata.devices[device].blksize);
-
- write_word(DS, SI+(Bit16u)&Int13DPT->size, 0x1a);
- write_word(DS, SI+(Bit16u)&Int13DPT->infos, 0x02); // geometry is valid
- write_dword(DS, SI+(Bit16u)&Int13DPT->cylinders, (Bit32u)npc);
- write_dword(DS, SI+(Bit16u)&Int13DPT->heads, (Bit32u)nph);
- write_dword(DS, SI+(Bit16u)&Int13DPT->spt, (Bit32u)npspt);
- write_dword(DS, SI+(Bit16u)&Int13DPT->sector_count1, lba); // FIXME should be Bit64
- write_dword(DS, SI+(Bit16u)&Int13DPT->sector_count2, 0L);
- write_word(DS, SI+(Bit16u)&Int13DPT->blksize, blksize);
- }
-
- // EDD 2.x
- if(size >= 0x1e) {
- Bit8u channel, dev, irq, mode, checksum, i, translation;
- Bit16u iobase1, iobase2, options;
-
- write_word(DS, SI+(Bit16u)&Int13DPT->size, 0x1e);
-
- write_word(DS, SI+(Bit16u)&Int13DPT->dpte_segment, ebda_seg);
- write_word(DS, SI+(Bit16u)&Int13DPT->dpte_offset, &EbdaData->ata.dpte);
-
- // Fill in dpte
- channel = device / 2;
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
- iobase2 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase2);
- irq = read_byte(ebda_seg, &EbdaData->ata.channels[channel].irq);
- mode = read_byte(ebda_seg, &EbdaData->ata.devices[device].mode);
- translation = read_byte(ebda_seg, &EbdaData->ata.devices[device].translation);
-
- options = (translation==ATA_TRANSLATION_NONE?0:1<<3); // chs translation
- options |= (1<<4); // lba translation
- options |= (mode==ATA_MODE_PIO32?1:0<<7);
- options |= (translation==ATA_TRANSLATION_LBA?1:0<<9);
- options |= (translation==ATA_TRANSLATION_RECHS?3:0<<9);
-
- write_word(ebda_seg, &EbdaData->ata.dpte.iobase1, iobase1);
- write_word(ebda_seg, &EbdaData->ata.dpte.iobase2, iobase2);
- write_byte(ebda_seg, &EbdaData->ata.dpte.prefix, (0xe | (device % 2))<<4 );
- write_byte(ebda_seg, &EbdaData->ata.dpte.unused, 0xcb );
- write_byte(ebda_seg, &EbdaData->ata.dpte.irq, irq );
- write_byte(ebda_seg, &EbdaData->ata.dpte.blkcount, 1 );
- write_byte(ebda_seg, &EbdaData->ata.dpte.dma, 0 );
- write_byte(ebda_seg, &EbdaData->ata.dpte.pio, 0 );
- write_word(ebda_seg, &EbdaData->ata.dpte.options, options);
- write_word(ebda_seg, &EbdaData->ata.dpte.reserved, 0);
- write_byte(ebda_seg, &EbdaData->ata.dpte.revision, 0x11);
-
- checksum=0;
- for (i=0; i<15; i++) checksum+=read_byte(ebda_seg, (&EbdaData->ata.dpte) + i);
- checksum = ~checksum;
- write_byte(ebda_seg, &EbdaData->ata.dpte.checksum, checksum);
- }
-
- // EDD 3.x
- if(size >= 0x42) {
- Bit8u channel, iface, checksum, i;
- Bit16u iobase1;
-
- channel = device / 2;
- iface = read_byte(ebda_seg, &EbdaData->ata.channels[channel].iface);
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
-
- write_word(DS, SI+(Bit16u)&Int13DPT->size, 0x42);
- write_word(DS, SI+(Bit16u)&Int13DPT->key, 0xbedd);
- write_byte(DS, SI+(Bit16u)&Int13DPT->dpi_length, 0x24);
- write_byte(DS, SI+(Bit16u)&Int13DPT->reserved1, 0);
- write_word(DS, SI+(Bit16u)&Int13DPT->reserved2, 0);
-
- if (iface==ATA_IFACE_ISA) {
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[0], 'I');
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[1], 'S');
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[2], 'A');
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[3], 0);
- }
- else {
- // FIXME PCI
- }
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[0], 'A');
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[1], 'T');
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[2], 'A');
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[3], 0);
-
- if (iface==ATA_IFACE_ISA) {
- write_word(DS, SI+(Bit16u)&Int13DPT->iface_path[0], iobase1);
- write_word(DS, SI+(Bit16u)&Int13DPT->iface_path[2], 0);
- write_dword(DS, SI+(Bit16u)&Int13DPT->iface_path[4], 0L);
- }
- else {
- // FIXME PCI
- }
- write_byte(DS, SI+(Bit16u)&Int13DPT->device_path[0], device%2);
- write_byte(DS, SI+(Bit16u)&Int13DPT->device_path[1], 0);
- write_word(DS, SI+(Bit16u)&Int13DPT->device_path[2], 0);
- write_dword(DS, SI+(Bit16u)&Int13DPT->device_path[4], 0L);
-
- checksum=0;
- for (i=30; i<64; i++) checksum+=read_byte(DS, SI + i);
- checksum = ~checksum;
- write_byte(DS, SI+(Bit16u)&Int13DPT->checksum, checksum);
- }
-
- goto int13_success;
- break;
-
- case 0x4e: // // IBM/MS set hardware configuration
- // DMA, prefetch, PIO maximum not supported
- switch (GET_AL()) {
- case 0x01:
- case 0x03:
- case 0x04:
- case 0x06:
- goto int13_success;
- break;
- default :
- goto int13_fail;
- }
- break;
-
- case 0x09: /* initialize drive parameters */
- case 0x0c: /* seek to specified cylinder */
- case 0x0d: /* alternate disk reset */
- case 0x11: /* recalibrate */
- case 0x14: /* controller internal diagnostic */
- BX_INFO("int13h_harddisk function %02xh unimplemented, returns success\n", GET_AH());
- goto int13_success;
- break;
-
- case 0x0a: /* read disk sectors with ECC */
- case 0x0b: /* write disk sectors with ECC */
- case 0x18: // set media type for format
- case 0x50: // IBM/MS send packet command
- default:
- BX_INFO("int13_harddisk function %02xh unsupported, returns fail\n", GET_AH());
- goto int13_fail;
- break;
- }
-
-int13_fail:
- SET_AH(0x01); // defaults to invalid function in AH or invalid parameter
-int13_fail_noah:
- SET_DISK_RET_STATUS(GET_AH());
-int13_fail_nostatus:
- SET_CF(); // error occurred
- return;
-
-int13_success:
- SET_AH(0x00); // no error
-int13_success_noah:
- SET_DISK_RET_STATUS(0x00);
- CLEAR_CF(); // no error
- return;
-}
-
-// ---------------------------------------------------------------------------
-// Start of int13 for cdrom
-// ---------------------------------------------------------------------------
-
- void
-int13_cdrom(EHBX, DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u EHBX, DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u device, status, locks;
- Bit8u atacmd[12];
- Bit32u lba;
- Bit16u count, segment, offset, i, size;
-
- BX_DEBUG_INT13_CD("int13_cdrom: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", AX, BX, CX, DX, ES);
-
- SET_DISK_RET_STATUS(0x00);
-
- /* basic check : device should be 0xE0+ */
- if( (GET_ELDL() < 0xE0) || (GET_ELDL() >= 0xE0+BX_MAX_ATA_DEVICES) ) {
- BX_INFO("int13_cdrom: function %02x, ELDL out of range %02x\n", GET_AH(), GET_ELDL());
- goto int13_fail;
- }
-
- // Get the ata channel
- device=read_byte(ebda_seg,&EbdaData->ata.cdidmap[GET_ELDL()-0xE0]);
-
- /* basic check : device has to be valid */
- if (device >= BX_MAX_ATA_DEVICES) {
- BX_INFO("int13_cdrom: function %02x, unmapped device for ELDL=%02x\n", GET_AH(), GET_ELDL());
- goto int13_fail;
- }
-
- switch (GET_AH()) {
-
- // all those functions return SUCCESS
- case 0x00: /* disk controller reset */
- case 0x09: /* initialize drive parameters */
- case 0x0c: /* seek to specified cylinder */
- case 0x0d: /* alternate disk reset */
- case 0x10: /* check drive ready */
- case 0x11: /* recalibrate */
- case 0x14: /* controller internal diagnostic */
- case 0x16: /* detect disk change */
- goto int13_success;
- break;
-
- // all those functions return disk write-protected
- case 0x03: /* write disk sectors */
- case 0x05: /* format disk track */
- case 0x43: // IBM/MS extended write
- SET_AH(0x03);
- goto int13_fail_noah;
- break;
-
- case 0x01: /* read disk status */
- status = read_byte(0x0040, 0x0074);
- SET_AH(status);
- SET_DISK_RET_STATUS(0);
-
- /* set CF if error status read */
- if (status) goto int13_fail_nostatus;
- else goto int13_success_noah;
- break;
-
- case 0x15: /* read disk drive size */
- SET_AH(0x02);
- goto int13_fail_noah;
- break;
-
- case 0x41: // IBM/MS installation check
- BX=0xaa55; // install check
- SET_AH(0x30); // EDD 2.1
- CX=0x0007; // ext disk access, removable and edd
- goto int13_success_noah;
- break;
-
- case 0x42: // IBM/MS extended read
- case 0x44: // IBM/MS verify sectors
- case 0x47: // IBM/MS extended seek
-
- count=read_word(DS, SI+(Bit16u)&Int13Ext->count);
- segment=read_word(DS, SI+(Bit16u)&Int13Ext->segment);
- offset=read_word(DS, SI+(Bit16u)&Int13Ext->offset);
-
- // Can't use 64 bits lba
- lba=read_dword(DS, SI+(Bit16u)&Int13Ext->lba2);
- if (lba != 0L) {
- BX_PANIC("int13_cdrom: function %02x. Can't use 64bits lba\n",GET_AH());
- goto int13_fail;
- }
-
- // Get 32 bits lba
- lba=read_dword(DS, SI+(Bit16u)&Int13Ext->lba1);
-
- // If verify or seek
- if (( GET_AH() == 0x44 ) || ( GET_AH() == 0x47 ))
- goto int13_success;
-
- memsetb(get_SS(),atacmd,0,12);
- atacmd[0]=0x28; // READ command
- atacmd[7]=(count & 0xff00) >> 8; // Sectors
- atacmd[8]=(count & 0x00ff); // Sectors
- atacmd[2]=(lba & 0xff000000) >> 24; // LBA
- atacmd[3]=(lba & 0x00ff0000) >> 16;
- atacmd[4]=(lba & 0x0000ff00) >> 8;
- atacmd[5]=(lba & 0x000000ff);
- status = ata_cmd_packet(device, 12, get_SS(), atacmd, 0, count*2048L, ATA_DATA_IN, segment,offset);
-
- count = (Bit16u)(read_dword(ebda_seg, &EbdaData->ata.trsfbytes) >> 11);
- write_word(DS, SI+(Bit16u)&Int13Ext->count, count);
-
- if (status != 0) {
- BX_INFO("int13_cdrom: function %02x, status %02x !\n",GET_AH(),status);
- SET_AH(0x0c);
- goto int13_fail_noah;
- }
-
- goto int13_success;
- break;
-
- case 0x45: // IBM/MS lock/unlock drive
- if (GET_AL() > 2) goto int13_fail;
-
- locks = read_byte(ebda_seg, &EbdaData->ata.devices[device].lock);
-
- switch (GET_AL()) {
- case 0 : // lock
- if (locks == 0xff) {
- SET_AH(0xb4);
- SET_AL(1);
- goto int13_fail_noah;
- }
- write_byte(ebda_seg, &EbdaData->ata.devices[device].lock, ++locks);
- SET_AL(1);
- break;
- case 1 : // unlock
- if (locks == 0x00) {
- SET_AH(0xb0);
- SET_AL(0);
- goto int13_fail_noah;
- }
- write_byte(ebda_seg, &EbdaData->ata.devices[device].lock, --locks);
- SET_AL(locks==0?0:1);
- break;
- case 2 : // status
- SET_AL(locks==0?0:1);
- break;
- }
- goto int13_success;
- break;
-
- case 0x46: // IBM/MS eject media
- locks = read_byte(ebda_seg, &EbdaData->ata.devices[device].lock);
-
- if (locks != 0) {
- SET_AH(0xb1); // media locked
- goto int13_fail_noah;
- }
- // FIXME should handle 0x31 no media in device
- // FIXME should handle 0xb5 valid request failed
-
- // Call removable media eject
- ASM_START
- push bp
- mov bp, sp
-
- mov ah, #0x52
- int 15
- mov _int13_cdrom.status + 2[bp], ah
- jnc int13_cdrom_rme_end
- mov _int13_cdrom.status, #1
-int13_cdrom_rme_end:
- pop bp
- ASM_END
-
- if (status != 0) {
- SET_AH(0xb1); // media locked
- goto int13_fail_noah;
- }
-
- goto int13_success;
- break;
-
- case 0x48: // IBM/MS get drive parameters
- size = read_word(DS,SI+(Bit16u)&Int13Ext->size);
-
- // Buffer is too small
- if(size < 0x1a)
- goto int13_fail;
-
- // EDD 1.x
- if(size >= 0x1a) {
- Bit16u cylinders, heads, spt, blksize;
-
- blksize = read_word(ebda_seg, &EbdaData->ata.devices[device].blksize);
-
- write_word(DS, SI+(Bit16u)&Int13DPT->size, 0x1a);
- write_word(DS, SI+(Bit16u)&Int13DPT->infos, 0x74); // removable, media change, lockable, max values
- write_dword(DS, SI+(Bit16u)&Int13DPT->cylinders, 0xffffffff);
- write_dword(DS, SI+(Bit16u)&Int13DPT->heads, 0xffffffff);
- write_dword(DS, SI+(Bit16u)&Int13DPT->spt, 0xffffffff);
- write_dword(DS, SI+(Bit16u)&Int13DPT->sector_count1, 0xffffffff); // FIXME should be Bit64
- write_dword(DS, SI+(Bit16u)&Int13DPT->sector_count2, 0xffffffff);
- write_word(DS, SI+(Bit16u)&Int13DPT->blksize, blksize);
- }
-
- // EDD 2.x
- if(size >= 0x1e) {
- Bit8u channel, dev, irq, mode, checksum, i;
- Bit16u iobase1, iobase2, options;
-
- write_word(DS, SI+(Bit16u)&Int13DPT->size, 0x1e);
-
- write_word(DS, SI+(Bit16u)&Int13DPT->dpte_segment, ebda_seg);
- write_word(DS, SI+(Bit16u)&Int13DPT->dpte_offset, &EbdaData->ata.dpte);
-
- // Fill in dpte
- channel = device / 2;
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
- iobase2 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase2);
- irq = read_byte(ebda_seg, &EbdaData->ata.channels[channel].irq);
- mode = read_byte(ebda_seg, &EbdaData->ata.devices[device].mode);
-
- // FIXME atapi device
- options = (1<<4); // lba translation
- options |= (1<<5); // removable device
- options |= (1<<6); // atapi device
- options |= (mode==ATA_MODE_PIO32?1:0<<7);
-
- write_word(ebda_seg, &EbdaData->ata.dpte.iobase1, iobase1);
- write_word(ebda_seg, &EbdaData->ata.dpte.iobase2, iobase2);
- write_byte(ebda_seg, &EbdaData->ata.dpte.prefix, (0xe | (device % 2))<<4 );
- write_byte(ebda_seg, &EbdaData->ata.dpte.unused, 0xcb );
- write_byte(ebda_seg, &EbdaData->ata.dpte.irq, irq );
- write_byte(ebda_seg, &EbdaData->ata.dpte.blkcount, 1 );
- write_byte(ebda_seg, &EbdaData->ata.dpte.dma, 0 );
- write_byte(ebda_seg, &EbdaData->ata.dpte.pio, 0 );
- write_word(ebda_seg, &EbdaData->ata.dpte.options, options);
- write_word(ebda_seg, &EbdaData->ata.dpte.reserved, 0);
- write_byte(ebda_seg, &EbdaData->ata.dpte.revision, 0x11);
-
- checksum=0;
- for (i=0; i<15; i++) checksum+=read_byte(ebda_seg, (&EbdaData->ata.dpte) + i);
- checksum = ~checksum;
- write_byte(ebda_seg, &EbdaData->ata.dpte.checksum, checksum);
- }
-
- // EDD 3.x
- if(size >= 0x42) {
- Bit8u channel, iface, checksum, i;
- Bit16u iobase1;
-
- channel = device / 2;
- iface = read_byte(ebda_seg, &EbdaData->ata.channels[channel].iface);
- iobase1 = read_word(ebda_seg, &EbdaData->ata.channels[channel].iobase1);
-
- write_word(DS, SI+(Bit16u)&Int13DPT->size, 0x42);
- write_word(DS, SI+(Bit16u)&Int13DPT->key, 0xbedd);
- write_byte(DS, SI+(Bit16u)&Int13DPT->dpi_length, 0x24);
- write_byte(DS, SI+(Bit16u)&Int13DPT->reserved1, 0);
- write_word(DS, SI+(Bit16u)&Int13DPT->reserved2, 0);
-
- if (iface==ATA_IFACE_ISA) {
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[0], 'I');
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[1], 'S');
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[2], 'A');
- write_byte(DS, SI+(Bit16u)&Int13DPT->host_bus[3], 0);
- }
- else {
- // FIXME PCI
- }
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[0], 'A');
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[1], 'T');
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[2], 'A');
- write_byte(DS, SI+(Bit16u)&Int13DPT->iface_type[3], 0);
-
- if (iface==ATA_IFACE_ISA) {
- write_word(DS, SI+(Bit16u)&Int13DPT->iface_path[0], iobase1);
- write_word(DS, SI+(Bit16u)&Int13DPT->iface_path[2], 0);
- write_dword(DS, SI+(Bit16u)&Int13DPT->iface_path[4], 0L);
- }
- else {
- // FIXME PCI
- }
- write_byte(DS, SI+(Bit16u)&Int13DPT->device_path[0], device%2);
- write_byte(DS, SI+(Bit16u)&Int13DPT->device_path[1], 0);
- write_word(DS, SI+(Bit16u)&Int13DPT->device_path[2], 0);
- write_dword(DS, SI+(Bit16u)&Int13DPT->device_path[4], 0L);
-
- checksum=0;
- for (i=30; i<64; i++) checksum+=read_byte(DS, SI + i);
- checksum = ~checksum;
- write_byte(DS, SI+(Bit16u)&Int13DPT->checksum, checksum);
- }
-
- goto int13_success;
- break;
-
- case 0x49: // IBM/MS extended media change
- // always send changed ??
- SET_AH(06);
- goto int13_fail_nostatus;
- break;
-
- case 0x4e: // // IBM/MS set hardware configuration
- // DMA, prefetch, PIO maximum not supported
- switch (GET_AL()) {
- case 0x01:
- case 0x03:
- case 0x04:
- case 0x06:
- goto int13_success;
- break;
- default :
- goto int13_fail;
- }
- break;
-
- // all those functions return unimplemented
- case 0x02: /* read sectors */
- case 0x04: /* verify sectors */
- case 0x08: /* read disk drive parameters */
- case 0x0a: /* read disk sectors with ECC */
- case 0x0b: /* write disk sectors with ECC */
- case 0x18: /* set media type for format */
- case 0x50: // ? - send packet command
- default:
- BX_INFO("int13_cdrom: unsupported AH=%02x\n", GET_AH());
- goto int13_fail;
- break;
- }
-
-int13_fail:
- SET_AH(0x01); // defaults to invalid function in AH or invalid parameter
-int13_fail_noah:
- SET_DISK_RET_STATUS(GET_AH());
-int13_fail_nostatus:
- SET_CF(); // error occurred
- return;
-
-int13_success:
- SET_AH(0x00); // no error
-int13_success_noah:
- SET_DISK_RET_STATUS(0x00);
- CLEAR_CF(); // no error
- return;
-}
-
-// ---------------------------------------------------------------------------
-// End of int13 for cdrom
-// ---------------------------------------------------------------------------
-
-#if BX_ELTORITO_BOOT
-// ---------------------------------------------------------------------------
-// Start of int13 for eltorito functions
-// ---------------------------------------------------------------------------
-
- void
-int13_eltorito(DS, ES, DI, SI, BP, SP, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u DS, ES, DI, SI, BP, SP, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
-
- BX_DEBUG_INT13_ET("int13_eltorito: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", AX, BX, CX, DX, ES);
- // BX_DEBUG_INT13_ET("int13_eltorito: SS=%04x DS=%04x ES=%04x DI=%04x SI=%04x\n",get_SS(), DS, ES, DI, SI);
-
- switch (GET_AH()) {
-
- // FIXME ElTorito Various. Should be implemented
- case 0x4a: // ElTorito - Initiate disk emu
- case 0x4c: // ElTorito - Initiate disk emu and boot
- case 0x4d: // ElTorito - Return Boot catalog
- BX_PANIC("Int13 eltorito call with AX=%04x. Please report\n",AX);
- goto int13_fail;
- break;
-
- case 0x4b: // ElTorito - Terminate disk emu
- // FIXME ElTorito Hardcoded
- write_byte(DS,SI+0x00,0x13);
- write_byte(DS,SI+0x01,read_byte(ebda_seg,&EbdaData->cdemu.media));
- write_byte(DS,SI+0x02,read_byte(ebda_seg,&EbdaData->cdemu.emulated_drive));
- write_byte(DS,SI+0x03,read_byte(ebda_seg,&EbdaData->cdemu.controller_index));
- write_dword(DS,SI+0x04,read_dword(ebda_seg,&EbdaData->cdemu.ilba));
- write_word(DS,SI+0x08,read_word(ebda_seg,&EbdaData->cdemu.device_spec));
- write_word(DS,SI+0x0a,read_word(ebda_seg,&EbdaData->cdemu.buffer_segment));
- write_word(DS,SI+0x0c,read_word(ebda_seg,&EbdaData->cdemu.load_segment));
- write_word(DS,SI+0x0e,read_word(ebda_seg,&EbdaData->cdemu.sector_count));
- write_byte(DS,SI+0x10,read_byte(ebda_seg,&EbdaData->cdemu.vdevice.cylinders));
- write_byte(DS,SI+0x11,read_byte(ebda_seg,&EbdaData->cdemu.vdevice.spt));
- write_byte(DS,SI+0x12,read_byte(ebda_seg,&EbdaData->cdemu.vdevice.heads));
-
- // If we have to terminate emulation
- if(GET_AL() == 0x00) {
- // FIXME ElTorito Various. Should be handled accordingly to spec
- write_byte(ebda_seg,&EbdaData->cdemu.active, 0x00); // bye bye
- }
-
- goto int13_success;
- break;
-
- default:
- BX_INFO("int13_eltorito: unsupported AH=%02x\n", GET_AH());
- goto int13_fail;
- break;
- }
-
-int13_fail:
- SET_AH(0x01); // defaults to invalid function in AH or invalid parameter
- SET_DISK_RET_STATUS(GET_AH());
- SET_CF(); // error occurred
- return;
-
-int13_success:
- SET_AH(0x00); // no error
- SET_DISK_RET_STATUS(0x00);
- CLEAR_CF(); // no error
- return;
-}
-
-// ---------------------------------------------------------------------------
-// End of int13 for eltorito functions
-// ---------------------------------------------------------------------------
-
-// ---------------------------------------------------------------------------
-// Start of int13 when emulating a device from the cd
-// ---------------------------------------------------------------------------
-
- void
-int13_cdemu(DS, ES, DI, SI, BP, SP, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u DS, ES, DI, SI, BP, SP, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit8u device, status;
- Bit16u vheads, vspt, vcylinders;
- Bit16u head, sector, cylinder, nbsectors;
- Bit32u vlba, ilba, slba, elba;
- Bit16u before, segment, offset;
- Bit8u atacmd[12];
-
- BX_DEBUG_INT13_ET("int13_cdemu: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", AX, BX, CX, DX, ES);
-
- /* at this point, we are emulating a floppy/harddisk */
-
- // Recompute the device number
- device = read_byte(ebda_seg,&EbdaData->cdemu.controller_index) * 2;
- device += read_byte(ebda_seg,&EbdaData->cdemu.device_spec);
-
- SET_DISK_RET_STATUS(0x00);
-
- /* basic checks : emulation should be active, dl should equal the emulated drive */
- if( (read_byte(ebda_seg,&EbdaData->cdemu.active) ==0 )
- || (read_byte(ebda_seg,&EbdaData->cdemu.emulated_drive ) != GET_DL())) {
- BX_INFO("int13_cdemu: function %02x, emulation not active for DL= %02x\n", GET_AH(), GET_DL());
- goto int13_fail;
- }
-
- switch (GET_AH()) {
-
- // all those functions return SUCCESS
- case 0x00: /* disk controller reset */
- case 0x09: /* initialize drive parameters */
- case 0x0c: /* seek to specified cylinder */
- case 0x0d: /* alternate disk reset */ // FIXME ElTorito Various. should really reset ?
- case 0x10: /* check drive ready */ // FIXME ElTorito Various. should check if ready ?
- case 0x11: /* recalibrate */
- case 0x14: /* controller internal diagnostic */
- case 0x16: /* detect disk change */
- goto int13_success;
- break;
-
- // all those functions return disk write-protected
- case 0x03: /* write disk sectors */
- case 0x05: /* format disk track */
- SET_AH(0x03);
- goto int13_fail_noah;
- break;
-
- case 0x01: /* read disk status */
- status=read_byte(0x0040, 0x0074);
- SET_AH(status);
- SET_DISK_RET_STATUS(0);
-
- /* set CF if error status read */
- if (status) goto int13_fail_nostatus;
- else goto int13_success_noah;
- break;
-
- case 0x02: // read disk sectors
- case 0x04: // verify disk sectors
- vspt = read_word(ebda_seg,&EbdaData->cdemu.vdevice.spt);
- vcylinders = read_word(ebda_seg,&EbdaData->cdemu.vdevice.cylinders);
- vheads = read_word(ebda_seg,&EbdaData->cdemu.vdevice.heads);
-
- ilba = read_dword(ebda_seg,&EbdaData->cdemu.ilba);
-
- sector = GET_CL() & 0x003f;
- cylinder = (GET_CL() & 0x00c0) << 2 | GET_CH();
- head = GET_DH();
- nbsectors = GET_AL();
- segment = ES;
- offset = BX;
-
- // no sector to read ?
- if(nbsectors==0) goto int13_success;
-
- // sanity checks sco openserver needs this!
- if ((sector > vspt)
- || (cylinder >= vcylinders)
- || (head >= vheads)) {
- goto int13_fail;
- }
-
- // After controls, verify do nothing
- if (GET_AH() == 0x04) goto int13_success;
-
- segment = ES+(BX / 16);
- offset = BX % 16;
-
- // calculate the virtual lba inside the image
- vlba=((((Bit32u)cylinder*(Bit32u)vheads)+(Bit32u)head)*(Bit32u)vspt)+((Bit32u)(sector-1));
-
- // In advance so we don't loose the count
- SET_AL(nbsectors);
-
- // start lba on cd
- slba = (Bit32u)vlba/4;
- before= (Bit16u)vlba%4;
-
- // end lba on cd
- elba = (Bit32u)(vlba+nbsectors-1)/4;
-
- memsetb(get_SS(),atacmd,0,12);
- atacmd[0]=0x28; // READ command
- atacmd[7]=((Bit16u)(elba-slba+1) & 0xff00) >> 8; // Sectors
- atacmd[8]=((Bit16u)(elba-slba+1) & 0x00ff); // Sectors
- atacmd[2]=(ilba+slba & 0xff000000) >> 24; // LBA
- atacmd[3]=(ilba+slba & 0x00ff0000) >> 16;
- atacmd[4]=(ilba+slba & 0x0000ff00) >> 8;
- atacmd[5]=(ilba+slba & 0x000000ff);
- if((status = ata_cmd_packet(device, 12, get_SS(), atacmd, before*512, nbsectors*512L, ATA_DATA_IN, segment,offset)) != 0) {
- BX_INFO("int13_cdemu: function %02x, error %02x !\n",GET_AH(),status);
- SET_AH(0x02);
- SET_AL(0);
- goto int13_fail_noah;
- }
-
- goto int13_success;
- break;
-
- case 0x08: /* read disk drive parameters */
- vspt=read_word(ebda_seg,&EbdaData->cdemu.vdevice.spt);
- vcylinders=read_word(ebda_seg,&EbdaData->cdemu.vdevice.cylinders) - 1;
- vheads=read_word(ebda_seg,&EbdaData->cdemu.vdevice.heads) - 1;
-
- SET_AL( 0x00 );
- SET_BL( 0x00 );
- SET_CH( vcylinders & 0xff );
- SET_CL((( vcylinders >> 2) & 0xc0) | ( vspt & 0x3f ));
- SET_DH( vheads );
- SET_DL( 0x02 ); // FIXME ElTorito Various. should send the real count of drives 1 or 2
- // FIXME ElTorito Harddisk. should send the HD count
-
- switch(read_byte(ebda_seg,&EbdaData->cdemu.media)) {
- case 0x01: SET_BL( 0x02 ); break;
- case 0x02: SET_BL( 0x04 ); break;
- case 0x03: SET_BL( 0x06 ); break;
- }
-
-ASM_START
- push bp
- mov bp, sp
- mov ax, #diskette_param_table2
- mov _int13_cdemu.DI+2[bp], ax
- mov _int13_cdemu.ES+2[bp], cs
- pop bp
-ASM_END
- goto int13_success;
- break;
-
- case 0x15: /* read disk drive size */
- // FIXME ElTorito Harddisk. What geometry to send ?
- SET_AH(0x03);
- goto int13_success_noah;
- break;
-
- // all those functions return unimplemented
- case 0x0a: /* read disk sectors with ECC */
- case 0x0b: /* write disk sectors with ECC */
- case 0x18: /* set media type for format */
- case 0x41: // IBM/MS installation check
- // FIXME ElTorito Harddisk. Darwin would like to use EDD
- case 0x42: // IBM/MS extended read
- case 0x43: // IBM/MS extended write
- case 0x44: // IBM/MS verify sectors
- case 0x45: // IBM/MS lock/unlock drive
- case 0x46: // IBM/MS eject media
- case 0x47: // IBM/MS extended seek
- case 0x48: // IBM/MS get drive parameters
- case 0x49: // IBM/MS extended media change
- case 0x4e: // ? - set hardware configuration
- case 0x50: // ? - send packet command
- default:
- BX_INFO("int13_cdemu function AH=%02x unsupported, returns fail\n", GET_AH());
- goto int13_fail;
- break;
- }
-
-int13_fail:
- SET_AH(0x01); // defaults to invalid function in AH or invalid parameter
-int13_fail_noah:
- SET_DISK_RET_STATUS(GET_AH());
-int13_fail_nostatus:
- SET_CF(); // error occurred
- return;
-
-int13_success:
- SET_AH(0x00); // no error
-int13_success_noah:
- SET_DISK_RET_STATUS(0x00);
- CLEAR_CF(); // no error
- return;
-}
-
-// ---------------------------------------------------------------------------
-// End of int13 when emulating a device from the cd
-// ---------------------------------------------------------------------------
-
-#endif // BX_ELTORITO_BOOT
-
-#else //BX_USE_ATADRV
-
- void
-outLBA(cylinder,hd_heads,head,hd_sectors,sector,dl)
- Bit16u cylinder;
- Bit16u hd_heads;
- Bit16u head;
- Bit16u hd_sectors;
- Bit16u sector;
- Bit16u dl;
-{
-ASM_START
- push bp
- mov bp, sp
- push eax
- push ebx
- push edx
- xor eax,eax
- mov ax,4[bp] // cylinder
- xor ebx,ebx
- mov bl,6[bp] // hd_heads
- imul ebx
-
- mov bl,8[bp] // head
- add eax,ebx
- mov bl,10[bp] // hd_sectors
- imul ebx
- mov bl,12[bp] // sector
- add eax,ebx
-
- dec eax
- mov dx,#0x1f3
- out dx,al
- mov dx,#0x1f4
- mov al,ah
- out dx,al
- shr eax,#16
- mov dx,#0x1f5
- out dx,al
- and ah,#0xf
- mov bl,14[bp] // dl
- and bl,#1
- shl bl,#4
- or ah,bl
- or ah,#0xe0
- mov al,ah
- mov dx,#0x01f6
- out dx,al
- pop edx
- pop ebx
- pop eax
- pop bp
-ASM_END
-}
-
- void
-int13_harddisk(DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit8u drive, num_sectors, sector, head, status, mod;
- Bit8u drive_map;
- Bit8u n_drives;
- Bit16u cyl_mod, ax;
- Bit16u max_cylinder, cylinder, total_sectors;
- Bit16u hd_cylinders;
- Bit8u hd_heads, hd_sectors;
- Bit16u val16;
- Bit8u sector_count;
- unsigned int i;
- Bit16u tempbx;
- Bit16u dpsize;
-
- Bit16u count, segment, offset;
- Bit32u lba;
- Bit16u error;
-
- BX_DEBUG_INT13_HD("int13 harddisk: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", AX, BX, CX, DX, ES);
-
- write_byte(0x0040, 0x008e, 0); // clear completion flag
-
- /* at this point, DL is >= 0x80 to be passed from the floppy int13h
- handler code */
- /* check how many disks first (cmos reg 0x12), return an error if
- drive not present */
- drive_map = inb_cmos(0x12);
- drive_map = (((drive_map & 0xf0)==0) ? 0 : 1) |
- (((drive_map & 0x0f)==0) ? 0 : 2);
- n_drives = (drive_map==0) ? 0 :
- ((drive_map==3) ? 2 : 1);
-
- if (!(drive_map & (1<<(GET_ELDL()&0x7f)))) { /* allow 0, 1, or 2 disks */
- SET_AH(0x01);
- SET_DISK_RET_STATUS(0x01);
- SET_CF(); /* error occurred */
- return;
- }
-
- switch (GET_AH()) {
-
- case 0x00: /* disk controller reset */
-BX_DEBUG_INT13_HD("int13_f00\n");
-
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- set_diskette_ret_status(0);
- set_diskette_current_cyl(0, 0); /* current cylinder, diskette 1 */
- set_diskette_current_cyl(1, 0); /* current cylinder, diskette 2 */
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x01: /* read disk status */
-BX_DEBUG_INT13_HD("int13_f01\n");
- status = read_byte(0x0040, 0x0074);
- SET_AH(status);
- SET_DISK_RET_STATUS(0);
- /* set CF if error status read */
- if (status) SET_CF();
- else CLEAR_CF();
- return;
- break;
-
- case 0x04: // verify disk sectors
- case 0x02: // read disk sectors
- drive = GET_ELDL();
- get_hd_geometry(drive, &hd_cylinders, &hd_heads, &hd_sectors);
-
- num_sectors = GET_AL();
- cylinder = (GET_CL() & 0x00c0) << 2 | GET_CH();
- sector = (GET_CL() & 0x3f);
- head = GET_DH();
-
-
- if (hd_cylinders > 1024) {
- if (hd_cylinders <= 2048) {
- cylinder <<= 1;
- }
- else if (hd_cylinders <= 4096) {
- cylinder <<= 2;
- }
- else if (hd_cylinders <= 8192) {
- cylinder <<= 3;
- }
- else { // hd_cylinders <= 16384
- cylinder <<= 4;
- }
-
- ax = head / hd_heads;
- cyl_mod = ax & 0xff;
- head = ax >> 8;
- cylinder |= cyl_mod;
- }
-
- if ( (cylinder >= hd_cylinders) ||
- (sector > hd_sectors) ||
- (head >= hd_heads) ) {
- SET_AH(1);
- SET_DISK_RET_STATUS(1);
- SET_CF(); /* error occurred */
- return;
- }
-
- if ( (num_sectors > 128) || (num_sectors == 0) )
- BX_PANIC("int13_harddisk(): num_sectors out of range!\n");
-
- if (head > 15)
- BX_PANIC("hard drive BIOS:(read/verify) head > 15\n");
-
- if ( GET_AH() == 0x04 ) {
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF();
- return;
- }
-
- status = inb(0x1f7);
- if (status & 0x80) {
- BX_PANIC("hard drive BIOS:(read/verify) BUSY bit set\n");
- }
- outb(0x01f2, num_sectors);
- /* activate LBA? (tomv) */
- if (hd_heads > 16) {
-BX_DEBUG_INT13_HD("CHS: %x %x %x\n", cylinder, head, sector);
- outLBA(cylinder,hd_heads,head,hd_sectors,sector,drive);
- }
- else {
- outb(0x01f3, sector);
- outb(0x01f4, cylinder & 0x00ff);
- outb(0x01f5, cylinder >> 8);
- outb(0x01f6, 0xa0 | ((drive & 0x01)<<4) | (head & 0x0f));
- }
- outb(0x01f7, 0x20);
-
- while (1) {
- status = inb(0x1f7);
- if ( !(status & 0x80) ) break;
- }
-
- if (status & 0x01) {
- BX_PANIC("hard drive BIOS:(read/verify) read error\n");
- } else if ( !(status & 0x08) ) {
- BX_DEBUG_INT13_HD("status was %02x\n", (unsigned) status);
- BX_PANIC("hard drive BIOS:(read/verify) expected DRQ=1\n");
- }
-
- sector_count = 0;
- tempbx = BX;
-
-ASM_START
- sti ;; enable higher priority interrupts
-ASM_END
-
- while (1) {
-ASM_START
- ;; store temp bx in real DI register
- push bp
- mov bp, sp
- mov di, _int13_harddisk.tempbx + 2 [bp]
- pop bp
-
- ;; adjust if there will be an overrun
- cmp di, #0xfe00
- jbe i13_f02_no_adjust
-i13_f02_adjust:
- sub di, #0x0200 ; sub 512 bytes from offset
- mov ax, es
- add ax, #0x0020 ; add 512 to segment
- mov es, ax
-
-i13_f02_no_adjust:
- mov cx, #0x0100 ;; counter (256 words = 512b)
- mov dx, #0x01f0 ;; AT data read port
-
- rep
- insw ;; CX words transfered from port(DX) to ES:[DI]
-
-i13_f02_done:
- ;; store real DI register back to temp bx
- push bp
- mov bp, sp
- mov _int13_harddisk.tempbx + 2 [bp], di
- pop bp
-ASM_END
-
- sector_count++;
- num_sectors--;
- if (num_sectors == 0) {
- status = inb(0x1f7);
- if ( (status & 0xc9) != 0x40 )
- BX_PANIC("no sectors left to read/verify, status is %02x\n", (unsigned) status);
- break;
- }
- else {
- status = inb(0x1f7);
- if ( (status & 0xc9) != 0x48 )
- BX_PANIC("more sectors left to read/verify, status is %02x\n", (unsigned) status);
- continue;
- }
- }
-
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- SET_AL(sector_count);
- CLEAR_CF(); /* successful */
- return;
- break;
-
-
- case 0x03: /* write disk sectors */
-BX_DEBUG_INT13_HD("int13_f03\n");
- drive = GET_ELDL ();
- get_hd_geometry(drive, &hd_cylinders, &hd_heads, &hd_sectors);
-
- num_sectors = GET_AL();
- cylinder = GET_CH();
- cylinder |= ( ((Bit16u) GET_CL()) << 2) & 0x300;
- sector = (GET_CL() & 0x3f);
- head = GET_DH();
-
- if (hd_cylinders > 1024) {
- if (hd_cylinders <= 2048) {
- cylinder <<= 1;
- }
- else if (hd_cylinders <= 4096) {
- cylinder <<= 2;
- }
- else if (hd_cylinders <= 8192) {
- cylinder <<= 3;
- }
- else { // hd_cylinders <= 16384
- cylinder <<= 4;
- }
-
- ax = head / hd_heads;
- cyl_mod = ax & 0xff;
- head = ax >> 8;
- cylinder |= cyl_mod;
- }
-
- if ( (cylinder >= hd_cylinders) ||
- (sector > hd_sectors) ||
- (head >= hd_heads) ) {
- SET_AH( 1);
- SET_DISK_RET_STATUS(1);
- SET_CF(); /* error occurred */
- return;
- }
-
- if ( (num_sectors > 128) || (num_sectors == 0) )
- BX_PANIC("int13_harddisk(): num_sectors out of range!\n");
-
- if (head > 15)
- BX_PANIC("hard drive BIOS:(read) head > 15\n");
-
- status = inb(0x1f7);
- if (status & 0x80) {
- BX_PANIC("hard drive BIOS:(read) BUSY bit set\n");
- }
-// should check for Drive Ready Bit also in status reg
- outb(0x01f2, num_sectors);
-
- /* activate LBA? (tomv) */
- if (hd_heads > 16) {
-BX_DEBUG_INT13_HD("CHS (write): %x %x %x\n", cylinder, head, sector);
- outLBA(cylinder,hd_heads,head,hd_sectors,sector,GET_ELDL());
- }
- else {
- outb(0x01f3, sector);
- outb(0x01f4, cylinder & 0x00ff);
- outb(0x01f5, cylinder >> 8);
- outb(0x01f6, 0xa0 | ((GET_ELDL() & 0x01)<<4) | (head & 0x0f));
- }
- outb(0x01f7, 0x30);
-
- // wait for busy bit to turn off after seeking
- while (1) {
- status = inb(0x1f7);
- if ( !(status & 0x80) ) break;
- }
-
- if ( !(status & 0x08) ) {
- BX_DEBUG_INT13_HD("status was %02x\n", (unsigned) status);
- BX_PANIC("hard drive BIOS:(write) data-request bit not set\n");
- }
-
- sector_count = 0;
- tempbx = BX;
-
-ASM_START
- sti ;; enable higher priority interrupts
-ASM_END
-
- while (1) {
-ASM_START
- ;; store temp bx in real SI register
- push bp
- mov bp, sp
- mov si, _int13_harddisk.tempbx + 2 [bp]
- pop bp
-
- ;; adjust if there will be an overrun
- cmp si, #0xfe00
- jbe i13_f03_no_adjust
-i13_f03_adjust:
- sub si, #0x0200 ; sub 512 bytes from offset
- mov ax, es
- add ax, #0x0020 ; add 512 to segment
- mov es, ax
-
-i13_f03_no_adjust:
- mov cx, #0x0100 ;; counter (256 words = 512b)
- mov dx, #0x01f0 ;; AT data read port
-
- seg ES
- rep
- outsw ;; CX words tranfered from ES:[SI] to port(DX)
-
- ;; store real SI register back to temp bx
- push bp
- mov bp, sp
- mov _int13_harddisk.tempbx + 2 [bp], si
- pop bp
-ASM_END
-
- sector_count++;
- num_sectors--;
- if (num_sectors == 0) {
- status = inb(0x1f7);
- if ( (status & 0xe9) != 0x40 )
- BX_PANIC("no sectors left to write, status is %02x\n", (unsigned) status);
- break;
- }
- else {
- status = inb(0x1f7);
- if ( (status & 0xc9) != 0x48 )
- BX_PANIC("more sectors left to write, status is %02x\n", (unsigned) status);
- continue;
- }
- }
-
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- SET_AL(sector_count);
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x05: /* format disk track */
-BX_DEBUG_INT13_HD("int13_f05\n");
- BX_PANIC("format disk track called\n");
- /* nop */
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x08: /* read disk drive parameters */
-BX_DEBUG_INT13_HD("int13_f08\n");
-
- drive = GET_ELDL ();
- get_hd_geometry(drive, &hd_cylinders, &hd_heads, &hd_sectors);
-
- // translate CHS
- //
- if (hd_cylinders <= 1024) {
- // hd_cylinders >>= 0;
- // hd_heads <<= 0;
- }
- else if (hd_cylinders <= 2048) {
- hd_cylinders >>= 1;
- hd_heads <<= 1;
- }
- else if (hd_cylinders <= 4096) {
- hd_cylinders >>= 2;
- hd_heads <<= 2;
- }
- else if (hd_cylinders <= 8192) {
- hd_cylinders >>= 3;
- hd_heads <<= 3;
- }
- else { // hd_cylinders <= 16384
- hd_cylinders >>= 4;
- hd_heads <<= 4;
- }
-
- max_cylinder = hd_cylinders - 2; /* 0 based */
- SET_AL(0);
- SET_CH(max_cylinder & 0xff);
- SET_CL(((max_cylinder >> 2) & 0xc0) | (hd_sectors & 0x3f));
- SET_DH(hd_heads - 1);
- SET_DL(n_drives); /* returns 0, 1, or 2 hard drives */
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
-
- return;
- break;
-
- case 0x09: /* initialize drive parameters */
-BX_DEBUG_INT13_HD("int13_f09\n");
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x0a: /* read disk sectors with ECC */
-BX_DEBUG_INT13_HD("int13_f0a\n");
- case 0x0b: /* write disk sectors with ECC */
-BX_DEBUG_INT13_HD("int13_f0b\n");
- BX_PANIC("int13h Functions 0Ah & 0Bh not implemented!\n");
- return;
- break;
-
- case 0x0c: /* seek to specified cylinder */
-BX_DEBUG_INT13_HD("int13_f0c\n");
- BX_INFO("int13h function 0ch (seek) not implemented!\n");
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x0d: /* alternate disk reset */
-BX_DEBUG_INT13_HD("int13_f0d\n");
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x10: /* check drive ready */
-BX_DEBUG_INT13_HD("int13_f10\n");
- //SET_AH(0);
- //SET_DISK_RET_STATUS(0);
- //CLEAR_CF(); /* successful */
- //return;
- //break;
-
- // should look at 40:8E also???
- status = inb(0x01f7);
- if ( (status & 0xc0) == 0x40 ) {
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); // drive ready
- return;
- }
- else {
- SET_AH(0xAA);
- SET_DISK_RET_STATUS(0xAA);
- SET_CF(); // not ready
- return;
- }
- break;
-
- case 0x11: /* recalibrate */
-BX_DEBUG_INT13_HD("int13_f11\n");
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
- return;
- break;
-
- case 0x14: /* controller internal diagnostic */
-BX_DEBUG_INT13_HD("int13_f14\n");
- SET_AH(0);
- SET_DISK_RET_STATUS(0);
- CLEAR_CF(); /* successful */
- SET_AL(0);
- return;
- break;
-
- case 0x15: /* read disk drive size */
- drive = GET_ELDL();
- get_hd_geometry(drive, &hd_cylinders, &hd_heads, &hd_sectors);
-ASM_START
- push bp
- mov bp, sp
- mov al, _int13_harddisk.hd_heads + 2 [bp]
- mov ah, _int13_harddisk.hd_sectors + 2 [bp]
- mul al, ah ;; ax = heads * sectors
- mov bx, _int13_harddisk.hd_cylinders + 2 [bp]
- dec bx ;; use (cylinders - 1) ???
- mul ax, bx ;; dx:ax = (cylinders -1) * (heads * sectors)
- ;; now we need to move the 32bit result dx:ax to what the
- ;; BIOS wants which is cx:dx.
- ;; and then into CX:DX on the stack
- mov _int13_harddisk.CX + 2 [bp], dx
- mov _int13_harddisk.DX + 2 [bp], ax
- pop bp
-ASM_END
- SET_AH(3); // hard disk accessible
- SET_DISK_RET_STATUS(0); // ??? should this be 0
- CLEAR_CF(); // successful
- return;
- break;
-
- case 0x18: // set media type for format
- case 0x41: // IBM/MS
- case 0x42: // IBM/MS
- case 0x43: // IBM/MS
- case 0x44: // IBM/MS
- case 0x45: // IBM/MS lock/unlock drive
- case 0x46: // IBM/MS eject media
- case 0x47: // IBM/MS extended seek
- case 0x49: // IBM/MS extended media change
- case 0x50: // IBM/MS send packet command
- default:
- BX_INFO("int13_harddisk: unsupported AH=%02x\n", GET_AH());
-
- SET_AH(1); // code=invalid function in AH or invalid parameter
- SET_DISK_RET_STATUS(1);
- SET_CF(); /* unsuccessful */
- return;
- break;
- }
-}
-
-static char panic_msg_reg12h[] = "HD%d cmos reg 12h not type F\n";
-static char panic_msg_reg19h[] = "HD%d cmos reg %02xh not user definable type 47\n";
-
- void
-get_hd_geometry(drive, hd_cylinders, hd_heads, hd_sectors)
- Bit8u drive;
- Bit16u *hd_cylinders;
- Bit8u *hd_heads;
- Bit8u *hd_sectors;
-{
- Bit8u hd_type;
- Bit16u ss;
- Bit16u cylinders;
- Bit8u iobase;
-
- ss = get_SS();
- if (drive == 0x80) {
- hd_type = inb_cmos(0x12) & 0xf0;
- if (hd_type != 0xf0)
- BX_INFO(panic_msg_reg12h,0);
- hd_type = inb_cmos(0x19); // HD0: extended type
- if (hd_type != 47)
- BX_INFO(panic_msg_reg19h,0,0x19);
- iobase = 0x1b;
- } else {
- hd_type = inb_cmos(0x12) & 0x0f;
- if (hd_type != 0x0f)
- BX_INFO(panic_msg_reg12h,1);
- hd_type = inb_cmos(0x1a); // HD0: extended type
- if (hd_type != 47)
- BX_INFO(panic_msg_reg19h,0,0x1a);
- iobase = 0x24;
- }
-
- // cylinders
- cylinders = inb_cmos(iobase) | (inb_cmos(iobase+1) << 8);
- write_word(ss, hd_cylinders, cylinders);
-
- // heads
- write_byte(ss, hd_heads, inb_cmos(iobase+2));
-
- // sectors per track
- write_byte(ss, hd_sectors, inb_cmos(iobase+8));
-}
-
-#endif //else BX_USE_ATADRV
-
-
-//////////////////////
-// FLOPPY functions //
-//////////////////////
-
-void floppy_reset_controller()
-{
- Bit8u val8;
-
- // Reset controller
- val8 = inb(0x03f2);
- outb(0x03f2, val8 & ~0x04);
- outb(0x03f2, val8 | 0x04);
-
- // Wait for controller to come out of reset
- do {
- val8 = inb(0x3f4);
- } while ( (val8 & 0xc0) != 0x80 );
-}
-
-void floppy_prepare_controller(drive)
- Bit16u drive;
-{
- Bit8u val8, dor, prev_reset;
-
- // set 40:3e bit 7 to 0
- val8 = read_byte(0x0040, 0x003e);
- val8 &= 0x7f;
- write_byte(0x0040, 0x003e, val8);
-
- // turn on motor of selected drive, DMA & int enabled, normal operation
- prev_reset = inb(0x03f2) & 0x04;
- if (drive)
- dor = 0x20;
- else
- dor = 0x10;
- dor |= 0x0c;
- dor |= drive;
- outb(0x03f2, dor);
-
- // reset the disk motor timeout value of INT 08
- write_byte(0x40,0x40, BX_FLOPPY_ON_CNT);
-
- // wait for drive readiness
- do {
- val8 = inb(0x3f4);
- } while ( (val8 & 0xc0) != 0x80 );
-
- if (prev_reset == 0) {
- // turn on interrupts
-ASM_START
- sti
-ASM_END
- // wait on 40:3e bit 7 to become 1
- do {
- val8 = read_byte(0x0040, 0x003e);
- } while ( (val8 & 0x80) == 0 );
- val8 &= 0x7f;
-ASM_START
- cli
-ASM_END
- write_byte(0x0040, 0x003e, val8);
- }
-}
-
- bx_bool
-floppy_media_known(drive)
- Bit16u drive;
-{
- Bit8u val8;
- Bit16u media_state_offset;
-
- val8 = read_byte(0x0040, 0x003e); // diskette recal status
- if (drive)
- val8 >>= 1;
- val8 &= 0x01;
- if (val8 == 0)
- return(0);
-
- media_state_offset = 0x0090;
- if (drive)
- media_state_offset += 1;
-
- val8 = read_byte(0x0040, media_state_offset);
- val8 = (val8 >> 4) & 0x01;
- if (val8 == 0)
- return(0);
-
- // check pass, return KNOWN
- return(1);
-}
-
- bx_bool
-floppy_media_sense(drive)
- Bit16u drive;
-{
- bx_bool retval;
- Bit16u media_state_offset;
- Bit8u drive_type, config_data, media_state;
-
- if (floppy_drive_recal(drive) == 0) {
- return(0);
- }
-
- // for now cheat and get drive type from CMOS,
- // assume media is same as drive type
-
- // ** config_data **
- // Bitfields for diskette media control:
- // Bit(s) Description (Table M0028)
- // 7-6 last data rate set by controller
- // 00=500kbps, 01=300kbps, 10=250kbps, 11=1Mbps
- // 5-4 last diskette drive step rate selected
- // 00=0Ch, 01=0Dh, 10=0Eh, 11=0Ah
- // 3-2 {data rate at start of operation}
- // 1-0 reserved
-
- // ** media_state **
- // Bitfields for diskette drive media state:
- // Bit(s) Description (Table M0030)
- // 7-6 data rate
- // 00=500kbps, 01=300kbps, 10=250kbps, 11=1Mbps
- // 5 double stepping required (e.g. 360kB in 1.2MB)
- // 4 media type established
- // 3 drive capable of supporting 4MB media
- // 2-0 on exit from BIOS, contains
- // 000 trying 360kB in 360kB
- // 001 trying 360kB in 1.2MB
- // 010 trying 1.2MB in 1.2MB
- // 011 360kB in 360kB established
- // 100 360kB in 1.2MB established
- // 101 1.2MB in 1.2MB established
- // 110 reserved
- // 111 all other formats/drives
-
- drive_type = inb_cmos(0x10);
- if (drive == 0)
- drive_type >>= 4;
- else
- drive_type &= 0x0f;
- if ( drive_type == 1 ) {
- // 360K 5.25" drive
- config_data = 0x00; // 0000 0000
- media_state = 0x25; // 0010 0101
- retval = 1;
- }
- else if ( drive_type == 2 ) {
- // 1.2 MB 5.25" drive
- config_data = 0x00; // 0000 0000
- media_state = 0x25; // 0010 0101 // need double stepping??? (bit 5)
- retval = 1;
- }
- else if ( drive_type == 3 ) {
- // 720K 3.5" drive
- config_data = 0x00; // 0000 0000 ???
- media_state = 0x17; // 0001 0111
- retval = 1;
- }
- else if ( drive_type == 4 ) {
- // 1.44 MB 3.5" drive
- config_data = 0x00; // 0000 0000
- media_state = 0x17; // 0001 0111
- retval = 1;
- }
- else if ( drive_type == 5 ) {
- // 2.88 MB 3.5" drive
- config_data = 0xCC; // 1100 1100
- media_state = 0xD7; // 1101 0111
- retval = 1;
- }
- //
- // Extended floppy size uses special cmos setting
- else if ( drive_type == 6 ) {
- // 160k 5.25" drive
- config_data = 0x00; // 0000 0000
- media_state = 0x27; // 0010 0111
- retval = 1;
- }
- else if ( drive_type == 7 ) {
- // 180k 5.25" drive
- config_data = 0x00; // 0000 0000
- media_state = 0x27; // 0010 0111
- retval = 1;
- }
- else if ( drive_type == 8 ) {
- // 320k 5.25" drive
- config_data = 0x00; // 0000 0000
- media_state = 0x27; // 0010 0111
- retval = 1;
- }
-
- else {
- // not recognized
- config_data = 0x00; // 0000 0000
- media_state = 0x00; // 0000 0000
- retval = 0;
- }
-
- if (drive == 0)
- media_state_offset = 0x90;
- else
- media_state_offset = 0x91;
- write_byte(0x0040, 0x008B, config_data);
- write_byte(0x0040, media_state_offset, media_state);
-
- return(retval);
-}
-
- bx_bool
-floppy_drive_recal(drive)
- Bit16u drive;
-{
- Bit8u val8;
- Bit16u curr_cyl_offset;
-
- floppy_prepare_controller(drive);
-
- // send Recalibrate command (2 bytes) to controller
- outb(0x03f5, 0x07); // 07: Recalibrate
- outb(0x03f5, drive); // 0=drive0, 1=drive1
-
- // turn on interrupts
-ASM_START
- sti
-ASM_END
-
- // wait on 40:3e bit 7 to become 1
- do {
- val8 = (read_byte(0x0040, 0x003e) & 0x80);
- } while ( val8 == 0 );
-
- val8 = 0; // separate asm from while() loop
- // turn off interrupts
-ASM_START
- cli
-ASM_END
-
- // set 40:3e bit 7 to 0, and calibrated bit
- val8 = read_byte(0x0040, 0x003e);
- val8 &= 0x7f;
- if (drive) {
- val8 |= 0x02; // Drive 1 calibrated
- curr_cyl_offset = 0x0095;
- } else {
- val8 |= 0x01; // Drive 0 calibrated
- curr_cyl_offset = 0x0094;
- }
- write_byte(0x0040, 0x003e, val8);
- write_byte(0x0040, curr_cyl_offset, 0); // current cylinder is 0
-
- return(1);
-}
-
-
-
- bx_bool
-floppy_drive_exists(drive)
- Bit16u drive;
-{
- Bit8u drive_type;
-
- // check CMOS to see if drive exists
- drive_type = inb_cmos(0x10);
- if (drive == 0)
- drive_type >>= 4;
- else
- drive_type &= 0x0f;
- if ( drive_type == 0 )
- return(0);
- else
- return(1);
-}
-
-#if BX_SUPPORT_FLOPPY
- void
-int13_diskette_function(DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit8u drive, num_sectors, track, sector, head, status;
- Bit16u base_address, base_count, base_es;
- Bit8u page, mode_register, val8, dor;
- Bit8u return_status[7];
- Bit8u drive_type, num_floppies, ah;
- Bit16u es, last_addr;
-
- BX_DEBUG_INT13_FL("int13_diskette: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", AX, BX, CX, DX, ES);
-
- ah = GET_AH();
-
- switch ( ah ) {
- case 0x00: // diskette controller reset
-BX_DEBUG_INT13_FL("floppy f00\n");
- drive = GET_ELDL();
- if (drive > 1) {
- SET_AH(1); // invalid param
- set_diskette_ret_status(1);
- SET_CF();
- return;
- }
- drive_type = inb_cmos(0x10);
-
- if (drive == 0)
- drive_type >>= 4;
- else
- drive_type &= 0x0f;
- if (drive_type == 0) {
- SET_AH(0x80); // drive not responding
- set_diskette_ret_status(0x80);
- SET_CF();
- return;
- }
- SET_AH(0);
- set_diskette_ret_status(0);
- CLEAR_CF(); // successful
- set_diskette_current_cyl(drive, 0); // current cylinder
- return;
-
- case 0x01: // Read Diskette Status
- CLEAR_CF();
- val8 = read_byte(0x0000, 0x0441);
- SET_AH(val8);
- if (val8) {
- SET_CF();
- }
- return;
-
- case 0x02: // Read Diskette Sectors
- case 0x03: // Write Diskette Sectors
- case 0x04: // Verify Diskette Sectors
- num_sectors = GET_AL();
- track = GET_CH();
- sector = GET_CL();
- head = GET_DH();
- drive = GET_ELDL();
-
- if ( (drive > 1) || (head > 1) ||
- (num_sectors == 0) || (num_sectors > 72) ) {
-BX_INFO("floppy: drive>1 || head>1 ...\n");
- SET_AH(1);
- set_diskette_ret_status(1);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
-
- // see if drive exists
- if (floppy_drive_exists(drive) == 0) {
- SET_AH(0x80); // not responding
- set_diskette_ret_status(0x80);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
-
- // see if media in drive, and type is known
- if (floppy_media_known(drive) == 0) {
- if (floppy_media_sense(drive) == 0) {
- SET_AH(0x0C); // Media type not found
- set_diskette_ret_status(0x0C);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
- }
-
- if (ah == 0x02) {
- // Read Diskette Sectors
-
- //-----------------------------------
- // set up DMA controller for transfer
- //-----------------------------------
-
- // es:bx = pointer to where to place information from diskette
- // port 04: DMA-1 base and current address, channel 2
- // port 05: DMA-1 base and current count, channel 2
- page = (ES >> 12); // upper 4 bits
- base_es = (ES << 4); // lower 16bits contributed by ES
- base_address = base_es + BX; // lower 16 bits of address
- // contributed by ES:BX
- if ( base_address < base_es ) {
- // in case of carry, adjust page by 1
- page++;
- }
- base_count = (num_sectors * 512) - 1;
-
- // check for 64K boundary overrun
- last_addr = base_address + base_count;
- if (last_addr < base_address) {
- SET_AH(0x09);
- set_diskette_ret_status(0x09);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
-
- BX_DEBUG_INT13_FL("masking DMA-1 c2\n");
- outb(0x000a, 0x06);
-
- BX_DEBUG_INT13_FL("clear flip-flop\n");
- outb(0x000c, 0x00); // clear flip-flop
- outb(0x0004, base_address);
- outb(0x0004, base_address>>8);
- BX_DEBUG_INT13_FL("clear flip-flop\n");
- outb(0x000c, 0x00); // clear flip-flop
- outb(0x0005, base_count);
- outb(0x0005, base_count>>8);
-
- // port 0b: DMA-1 Mode Register
- mode_register = 0x46; // single mode, increment, autoinit disable,
- // transfer type=write, channel 2
- BX_DEBUG_INT13_FL("setting mode register\n");
- outb(0x000b, mode_register);
-
- BX_DEBUG_INT13_FL("setting page register\n");
- // port 81: DMA-1 Page Register, channel 2
- outb(0x0081, page);
-
- BX_DEBUG_INT13_FL("unmask chan 2\n");
- outb(0x000a, 0x02); // unmask channel 2
-
- BX_DEBUG_INT13_FL("unmasking DMA-1 c2\n");
- outb(0x000a, 0x02);
-
- //--------------------------------------
- // set up floppy controller for transfer
- //--------------------------------------
- floppy_prepare_controller(drive);
-
- // send read-normal-data command (9 bytes) to controller
- outb(0x03f5, 0xe6); // e6: read normal data
- outb(0x03f5, (head << 2) | drive); // HD DR1 DR2
- outb(0x03f5, track);
- outb(0x03f5, head);
- outb(0x03f5, sector);
- outb(0x03f5, 2); // 512 byte sector size
- outb(0x03f5, sector + num_sectors - 1); // last sector to read on track
- outb(0x03f5, 0); // Gap length
- outb(0x03f5, 0xff); // Gap length
-
- // turn on interrupts
- ASM_START
- sti
- ASM_END
-
- // wait on 40:3e bit 7 to become 1
- do {
- val8 = read_byte(0x0040, 0x0040);
- if (val8 == 0) {
- floppy_reset_controller();
- SET_AH(0x80); // drive not ready (timeout)
- set_diskette_ret_status(0x80);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
- val8 = (read_byte(0x0040, 0x003e) & 0x80);
- } while ( val8 == 0 );
-
- val8 = 0; // separate asm from while() loop
- // turn off interrupts
- ASM_START
- cli
- ASM_END
-
- // set 40:3e bit 7 to 0
- val8 = read_byte(0x0040, 0x003e);
- val8 &= 0x7f;
- write_byte(0x0040, 0x003e, val8);
-
- // check port 3f4 for accessibility to status bytes
- val8 = inb(0x3f4);
- if ( (val8 & 0xc0) != 0xc0 )
- BX_PANIC("int13_diskette: ctrl not ready\n");
-
- // read 7 return status bytes from controller
- // using loop index broken, have to unroll...
- return_status[0] = inb(0x3f5);
- return_status[1] = inb(0x3f5);
- return_status[2] = inb(0x3f5);
- return_status[3] = inb(0x3f5);
- return_status[4] = inb(0x3f5);
- return_status[5] = inb(0x3f5);
- return_status[6] = inb(0x3f5);
- // record in BIOS Data Area
- write_byte(0x0040, 0x0042, return_status[0]);
- write_byte(0x0040, 0x0043, return_status[1]);
- write_byte(0x0040, 0x0044, return_status[2]);
- write_byte(0x0040, 0x0045, return_status[3]);
- write_byte(0x0040, 0x0046, return_status[4]);
- write_byte(0x0040, 0x0047, return_status[5]);
- write_byte(0x0040, 0x0048, return_status[6]);
-
- if ( (return_status[0] & 0xc0) != 0 ) {
- SET_AH(0x20);
- set_diskette_ret_status(0x20);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
-
- // ??? should track be new val from return_status[3] ?
- set_diskette_current_cyl(drive, track);
- // AL = number of sectors read (same value as passed)
- SET_AH(0x00); // success
- CLEAR_CF(); // success
- return;
- } else if (ah == 0x03) {
- // Write Diskette Sectors
-
- //-----------------------------------
- // set up DMA controller for transfer
- //-----------------------------------
-
- // es:bx = pointer to where to place information from diskette
- // port 04: DMA-1 base and current address, channel 2
- // port 05: DMA-1 base and current count, channel 2
- page = (ES >> 12); // upper 4 bits
- base_es = (ES << 4); // lower 16bits contributed by ES
- base_address = base_es + BX; // lower 16 bits of address
- // contributed by ES:BX
- if ( base_address < base_es ) {
- // in case of carry, adjust page by 1
- page++;
- }
- base_count = (num_sectors * 512) - 1;
-
- // check for 64K boundary overrun
- last_addr = base_address + base_count;
- if (last_addr < base_address) {
- SET_AH(0x09);
- set_diskette_ret_status(0x09);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
-
- BX_DEBUG_INT13_FL("masking DMA-1 c2\n");
- outb(0x000a, 0x06);
-
- outb(0x000c, 0x00); // clear flip-flop
- outb(0x0004, base_address);
- outb(0x0004, base_address>>8);
- outb(0x000c, 0x00); // clear flip-flop
- outb(0x0005, base_count);
- outb(0x0005, base_count>>8);
-
- // port 0b: DMA-1 Mode Register
- mode_register = 0x4a; // single mode, increment, autoinit disable,
- // transfer type=read, channel 2
- outb(0x000b, mode_register);
-
- // port 81: DMA-1 Page Register, channel 2
- outb(0x0081, page);
-
- BX_DEBUG_INT13_FL("unmasking DMA-1 c2\n");
- outb(0x000a, 0x02);
-
- //--------------------------------------
- // set up floppy controller for transfer
- //--------------------------------------
- floppy_prepare_controller(drive);
-
- // send write-normal-data command (9 bytes) to controller
- outb(0x03f5, 0xc5); // c5: write normal data
- outb(0x03f5, (head << 2) | drive); // HD DR1 DR2
- outb(0x03f5, track);
- outb(0x03f5, head);
- outb(0x03f5, sector);
- outb(0x03f5, 2); // 512 byte sector size
- outb(0x03f5, sector + num_sectors - 1); // last sector to write on track
- outb(0x03f5, 0); // Gap length
- outb(0x03f5, 0xff); // Gap length
-
- // turn on interrupts
- ASM_START
- sti
- ASM_END
-
- // wait on 40:3e bit 7 to become 1
- do {
- val8 = read_byte(0x0040, 0x0040);
- if (val8 == 0) {
- floppy_reset_controller();
- SET_AH(0x80); // drive not ready (timeout)
- set_diskette_ret_status(0x80);
- SET_AL(0); // no sectors written
- SET_CF(); // error occurred
- return;
- }
- val8 = (read_byte(0x0040, 0x003e) & 0x80);
- } while ( val8 == 0 );
-
- val8 = 0; // separate asm from while() loop
- // turn off interrupts
- ASM_START
- cli
- ASM_END
-
- // set 40:3e bit 7 to 0
- val8 = read_byte(0x0040, 0x003e);
- val8 &= 0x7f;
- write_byte(0x0040, 0x003e, val8);
-
- // check port 3f4 for accessibility to status bytes
- val8 = inb(0x3f4);
- if ( (val8 & 0xc0) != 0xc0 )
- BX_PANIC("int13_diskette: ctrl not ready\n");
-
- // read 7 return status bytes from controller
- // using loop index broken, have to unroll...
- return_status[0] = inb(0x3f5);
- return_status[1] = inb(0x3f5);
- return_status[2] = inb(0x3f5);
- return_status[3] = inb(0x3f5);
- return_status[4] = inb(0x3f5);
- return_status[5] = inb(0x3f5);
- return_status[6] = inb(0x3f5);
- // record in BIOS Data Area
- write_byte(0x0040, 0x0042, return_status[0]);
- write_byte(0x0040, 0x0043, return_status[1]);
- write_byte(0x0040, 0x0044, return_status[2]);
- write_byte(0x0040, 0x0045, return_status[3]);
- write_byte(0x0040, 0x0046, return_status[4]);
- write_byte(0x0040, 0x0047, return_status[5]);
- write_byte(0x0040, 0x0048, return_status[6]);
-
- if ( (return_status[0] & 0xc0) != 0 ) {
- if ( (return_status[1] & 0x02) != 0 ) {
- // diskette not writable.
- // AH=status code=0x03 (tried to write on write-protected disk)
- // AL=number of sectors written=0
- AX = 0x0300;
- SET_CF();
- return;
- } else {
- BX_PANIC("int13_diskette_function: read error\n");
- }
- }
-
- // ??? should track be new val from return_status[3] ?
- set_diskette_current_cyl(drive, track);
- // AL = number of sectors read (same value as passed)
- SET_AH(0x00); // success
- CLEAR_CF(); // success
- return;
- } else { // if (ah == 0x04)
- // Verify Diskette Sectors
-
- // ??? should track be new val from return_status[3] ?
- set_diskette_current_cyl(drive, track);
- // AL = number of sectors verified (same value as passed)
- CLEAR_CF(); // success
- SET_AH(0x00); // success
- return;
- }
- break;
-
- case 0x05: // format diskette track
-BX_DEBUG_INT13_FL("floppy f05\n");
-
- num_sectors = GET_AL();
- track = GET_CH();
- head = GET_DH();
- drive = GET_ELDL();
-
- if ((drive > 1) || (head > 1) || (track > 79) ||
- (num_sectors == 0) || (num_sectors > 18)) {
- SET_AH(1);
- set_diskette_ret_status(1);
- SET_CF(); // error occurred
- }
-
- // see if drive exists
- if (floppy_drive_exists(drive) == 0) {
- SET_AH(0x80); // drive not responding
- set_diskette_ret_status(0x80);
- SET_CF(); // error occurred
- return;
- }
-
- // see if media in drive, and type is known
- if (floppy_media_known(drive) == 0) {
- if (floppy_media_sense(drive) == 0) {
- SET_AH(0x0C); // Media type not found
- set_diskette_ret_status(0x0C);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
- }
-
- // set up DMA controller for transfer
- page = (ES >> 12); // upper 4 bits
- base_es = (ES << 4); // lower 16bits contributed by ES
- base_address = base_es + BX; // lower 16 bits of address
- // contributed by ES:BX
- if ( base_address < base_es ) {
- // in case of carry, adjust page by 1
- page++;
- }
- base_count = (num_sectors * 4) - 1;
-
- // check for 64K boundary overrun
- last_addr = base_address + base_count;
- if (last_addr < base_address) {
- SET_AH(0x09);
- set_diskette_ret_status(0x09);
- SET_AL(0); // no sectors read
- SET_CF(); // error occurred
- return;
- }
-
- outb(0x000a, 0x06);
- outb(0x000c, 0x00); // clear flip-flop
- outb(0x0004, base_address);
- outb(0x0004, base_address>>8);
- outb(0x000c, 0x00); // clear flip-flop
- outb(0x0005, base_count);
- outb(0x0005, base_count>>8);
- mode_register = 0x4a; // single mode, increment, autoinit disable,
- // transfer type=read, channel 2
- outb(0x000b, mode_register);
- // port 81: DMA-1 Page Register, channel 2
- outb(0x0081, page);
- outb(0x000a, 0x02);
-
- // set up floppy controller for transfer
- floppy_prepare_controller(drive);
-
- // send format-track command (6 bytes) to controller
- outb(0x03f5, 0x4d); // 4d: format track
- outb(0x03f5, (head << 2) | drive); // HD DR1 DR2
- outb(0x03f5, 2); // 512 byte sector size
- outb(0x03f5, num_sectors); // number of sectors per track
- outb(0x03f5, 0); // Gap length
- outb(0x03f5, 0xf6); // Fill byte
- // turn on interrupts
- ASM_START
- sti
- ASM_END
-
- // wait on 40:3e bit 7 to become 1
- do {
- val8 = read_byte(0x0040, 0x0040);
- if (val8 == 0) {
- floppy_reset_controller();
- SET_AH(0x80); // drive not ready (timeout)
- set_diskette_ret_status(0x80);
- SET_CF(); // error occurred
- return;
- }
- val8 = (read_byte(0x0040, 0x003e) & 0x80);
- } while ( val8 == 0 );
-
- val8 = 0; // separate asm from while() loop
- // turn off interrupts
- ASM_START
- cli
- ASM_END
- // set 40:3e bit 7 to 0
- val8 = read_byte(0x0040, 0x003e);
- val8 &= 0x7f;
- write_byte(0x0040, 0x003e, val8);
- // check port 3f4 for accessibility to status bytes
- val8 = inb(0x3f4);
- if ( (val8 & 0xc0) != 0xc0 )
- BX_PANIC("int13_diskette: ctrl not ready\n");
-
- // read 7 return status bytes from controller
- // using loop index broken, have to unroll...
- return_status[0] = inb(0x3f5);
- return_status[1] = inb(0x3f5);
- return_status[2] = inb(0x3f5);
- return_status[3] = inb(0x3f5);
- return_status[4] = inb(0x3f5);
- return_status[5] = inb(0x3f5);
- return_status[6] = inb(0x3f5);
- // record in BIOS Data Area
- write_byte(0x0040, 0x0042, return_status[0]);
- write_byte(0x0040, 0x0043, return_status[1]);
- write_byte(0x0040, 0x0044, return_status[2]);
- write_byte(0x0040, 0x0045, return_status[3]);
- write_byte(0x0040, 0x0046, return_status[4]);
- write_byte(0x0040, 0x0047, return_status[5]);
- write_byte(0x0040, 0x0048, return_status[6]);
-
- if ( (return_status[0] & 0xc0) != 0 ) {
- if ( (return_status[1] & 0x02) != 0 ) {
- // diskette not writable.
- // AH=status code=0x03 (tried to write on write-protected disk)
- // AL=number of sectors written=0
- AX = 0x0300;
- SET_CF();
- return;
- } else {
- BX_PANIC("int13_diskette_function: write error\n");
- }
- }
-
- SET_AH(0);
- set_diskette_ret_status(0);
- set_diskette_current_cyl(drive, 0);
- CLEAR_CF(); // successful
- return;
-
-
- case 0x08: // read diskette drive parameters
-BX_DEBUG_INT13_FL("floppy f08\n");
- drive = GET_ELDL();
-
- if (drive > 1) {
- AX = 0;
- BX = 0;
- CX = 0;
- DX = 0;
- ES = 0;
- DI = 0;
- SET_DL(num_floppies);
- SET_CF();
- return;
- }
-
- drive_type = inb_cmos(0x10);
- num_floppies = 0;
- if (drive_type & 0xf0)
- num_floppies++;
- if (drive_type & 0x0f)
- num_floppies++;
-
- if (drive == 0)
- drive_type >>= 4;
- else
- drive_type &= 0x0f;
-
- SET_BH(0);
- SET_BL(drive_type);
- SET_AH(0);
- SET_AL(0);
- SET_DL(num_floppies);
-
- switch (drive_type) {
- case 0: // none
- CX = 0;
- SET_DH(0); // max head #
- break;
-
- case 1: // 360KB, 5.25"
- CX = 0x2709; // 40 tracks, 9 sectors
- SET_DH(1); // max head #
- break;
-
- case 2: // 1.2MB, 5.25"
- CX = 0x4f0f; // 80 tracks, 15 sectors
- SET_DH(1); // max head #
- break;
-
- case 3: // 720KB, 3.5"
- CX = 0x4f09; // 80 tracks, 9 sectors
- SET_DH(1); // max head #
- break;
-
- case 4: // 1.44MB, 3.5"
- CX = 0x4f12; // 80 tracks, 18 sectors
- SET_DH(1); // max head #
- break;
-
- case 5: // 2.88MB, 3.5"
- CX = 0x4f24; // 80 tracks, 36 sectors
- SET_DH(1); // max head #
- break;
-
- case 6: // 160k, 5.25"
- CX = 0x2708; // 40 tracks, 8 sectors
- SET_DH(0); // max head #
- break;
-
- case 7: // 180k, 5.25"
- CX = 0x2709; // 40 tracks, 9 sectors
- SET_DH(0); // max head #
- break;
-
- case 8: // 320k, 5.25"
- CX = 0x2708; // 40 tracks, 8 sectors
- SET_DH(1); // max head #
- break;
-
- default: // ?
- BX_PANIC("floppy: int13: bad floppy type\n");
- }
-
- /* set es & di to point to 11 byte diskette param table in ROM */
-ASM_START
- push bp
- mov bp, sp
- mov ax, #diskette_param_table2
- mov _int13_diskette_function.DI+2[bp], ax
- mov _int13_diskette_function.ES+2[bp], cs
- pop bp
-ASM_END
- CLEAR_CF(); // success
- /* disk status not changed upon success */
- return;
-
-
- case 0x15: // read diskette drive type
-BX_DEBUG_INT13_FL("floppy f15\n");
- drive = GET_ELDL();
- if (drive > 1) {
- SET_AH(0); // only 2 drives supported
- // set_diskette_ret_status here ???
- SET_CF();
- return;
- }
- drive_type = inb_cmos(0x10);
-
- if (drive == 0)
- drive_type >>= 4;
- else
- drive_type &= 0x0f;
- CLEAR_CF(); // successful, not present
- if (drive_type==0) {
- SET_AH(0); // drive not present
- }
- else {
- SET_AH(1); // drive present, does not support change line
- }
-
- return;
-
- case 0x16: // get diskette change line status
-BX_DEBUG_INT13_FL("floppy f16\n");
- drive = GET_ELDL();
- if (drive > 1) {
- SET_AH(0x01); // invalid drive
- set_diskette_ret_status(0x01);
- SET_CF();
- return;
- }
-
- SET_AH(0x06); // change line not supported
- set_diskette_ret_status(0x06);
- SET_CF();
- return;
-
- case 0x17: // set diskette type for format(old)
-BX_DEBUG_INT13_FL("floppy f17\n");
- /* not used for 1.44M floppies */
- SET_AH(0x01); // not supported
- set_diskette_ret_status(1); /* not supported */
- SET_CF();
- return;
-
- case 0x18: // set diskette type for format(new)
-BX_DEBUG_INT13_FL("floppy f18\n");
- SET_AH(0x01); // do later
- set_diskette_ret_status(1);
- SET_CF();
- return;
-
- default:
- BX_INFO("int13_diskette: unsupported AH=%02x\n", GET_AH());
-
- // if ( (ah==0x20) || ((ah>=0x41) && (ah<=0x49)) || (ah==0x4e) ) {
- SET_AH(0x01); // ???
- set_diskette_ret_status(1);
- SET_CF();
- return;
- // }
- }
-}
-#else // #if BX_SUPPORT_FLOPPY
- void
-int13_diskette_function(DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS)
- Bit16u DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS;
-{
- Bit8u val8;
-
- switch ( GET_AH() ) {
-
- case 0x01: // Read Diskette Status
- CLEAR_CF();
- val8 = read_byte(0x0000, 0x0441);
- SET_AH(val8);
- if (val8) {
- SET_CF();
- }
- return;
-
- default:
- SET_CF();
- write_byte(0x0000, 0x0441, 0x01);
- SET_AH(0x01);
- }
-}
-#endif // #if BX_SUPPORT_FLOPPY
-
- void
-set_diskette_ret_status(value)
- Bit8u value;
-{
- write_byte(0x0040, 0x0041, value);
-}
-
- void
-set_diskette_current_cyl(drive, cyl)
- Bit8u drive;
- Bit8u cyl;
-{
- if (drive > 1)
- BX_PANIC("set_diskette_current_cyl(): drive > 1\n");
- write_byte(0x0040, 0x0094+drive, cyl);
-}
-
- void
-determine_floppy_media(drive)
- Bit16u drive;
-{
-#if 0
- Bit8u val8, DOR, ctrl_info;
-
- ctrl_info = read_byte(0x0040, 0x008F);
- if (drive==1)
- ctrl_info >>= 4;
- else
- ctrl_info &= 0x0f;
-
-#if 0
- if (drive == 0) {
- DOR = 0x1c; // DOR: drive0 motor on, DMA&int enabled, normal op, drive select 0
- }
- else {
- DOR = 0x2d; // DOR: drive1 motor on, DMA&int enabled, normal op, drive select 1
- }
-#endif
-
- if ( (ctrl_info & 0x04) != 0x04 ) {
- // Drive not determined means no drive exists, done.
- return;
- }
-
-#if 0
- // check Main Status Register for readiness
- val8 = inb(0x03f4) & 0x80; // Main Status Register
- if (val8 != 0x80)
- BX_PANIC("d_f_m: MRQ bit not set\n");
-
- // change line
-
- // existing BDA values
-
- // turn on drive motor
- outb(0x03f2, DOR); // Digital Output Register
- //
-#endif
- BX_PANIC("d_f_m: OK so far\n");
-#endif
-}
-
- void
-int17_function(regs, ds, iret_addr)
- pusha_regs_t regs; // regs pushed from PUSHA instruction
- Bit16u ds; // previous DS:, DS set to 0x0000 by asm wrapper
- iret_addr_t iret_addr; // CS,IP,Flags pushed from original INT call
-{
- Bit16u addr,timeout;
- Bit8u val8;
-
- ASM_START
- sti
- ASM_END
-
- addr = read_word(0x0040, (regs.u.r16.dx << 1) + 8);
- if ((regs.u.r8.ah < 3) && (regs.u.r16.dx < 3) && (addr > 0)) {
- timeout = read_byte(0x0040, 0x0078 + regs.u.r16.dx) << 8;
- if (regs.u.r8.ah == 0) {
- outb(addr, regs.u.r8.al);
- val8 = inb(addr+2);
- outb(addr+2, val8 | 0x01); // send strobe
- ASM_START
- nop
- ASM_END
- outb(addr+2, val8 & ~0x01);
- while (((inb(addr+1) & 0x40) == 0x40) && (timeout)) {
- timeout--;
- }
- }
- if (regs.u.r8.ah == 1) {
- val8 = inb(addr+2);
- outb(addr+2, val8 & ~0x04); // send init
- ASM_START
- nop
- ASM_END
- outb(addr+2, val8 | 0x04);
- }
- val8 = inb(addr+1);
- regs.u.r8.ah = (val8 ^ 0x48);
- if (!timeout) regs.u.r8.ah |= 0x01;
- ClearCF(iret_addr.flags);
- } else {
- SetCF(iret_addr.flags); // Unsupported
- }
-}
-
-// returns bootsegment in ax, drive in bl
- Bit32u
-int19_function(bseqnr)
-Bit8u bseqnr;
-{
- Bit16u ebda_seg=read_word(0x0040,0x000E);
- Bit16u bootseq;
- Bit8u bootdrv;
- Bit8u bootcd;
- Bit8u bootchk;
- Bit16u bootseg;
- Bit16u status;
- Bit8u lastdrive=0;
-
- // if BX_ELTORITO_BOOT is not defined, old behavior
- // check bit 5 in CMOS reg 0x2d. load either 0x00 or 0x80 into DL
- // in preparation for the intial INT 13h (0=floppy A:, 0x80=C:)
- // 0: system boot sequence, first drive C: then A:
- // 1: system boot sequence, first drive A: then C:
- // else BX_ELTORITO_BOOT is defined
- // CMOS regs 0x3D and 0x38 contain the boot sequence:
- // CMOS reg 0x3D & 0x0f : 1st boot device
- // CMOS reg 0x3D & 0xf0 : 2nd boot device
- // CMOS reg 0x38 & 0xf0 : 3rd boot device
- // boot device codes:
- // 0x00 : not defined
- // 0x01 : first floppy
- // 0x02 : first harddrive
- // 0x03 : first cdrom
- // else : boot failure
-
- // Get the boot sequence
-#if BX_ELTORITO_BOOT
- bootseq=inb_cmos(0x3d);
- bootseq|=((inb_cmos(0x38) & 0xf0) << 4);
-
- if (bseqnr==2) bootseq >>= 4;
- if (bseqnr==3) bootseq >>= 8;
- if (bootseq<0x10) lastdrive = 1;
- bootdrv=0x00; bootcd=0;
- switch(bootseq & 0x0f) {
- case 0x01: bootdrv=0x00; bootcd=0; break;
- case 0x02: bootdrv=0x80; bootcd=0; break;
- case 0x03: bootdrv=0x00; bootcd=1; break;
- default: return 0x00000000;
- }
-#else
- bootseq=inb_cmos(0x2d);
-
- if (bseqnr==2) {
- bootseq ^= 0x20;
- lastdrive = 1;
- }
- bootdrv=0x00; bootcd=0;
- if((bootseq&0x20)==0) bootdrv=0x80;
-#endif // BX_ELTORITO_BOOT
-
-#if BX_ELTORITO_BOOT
- // We have to boot from cd
- if (bootcd != 0) {
- status = cdrom_boot();
-
- // If failure
- if ( (status & 0x00ff) !=0 ) {
- print_cdromboot_failure(status);
- print_boot_failure(bootcd, bootdrv, 1, lastdrive);
- return 0x00000000;
- }
-
- bootseg = read_word(ebda_seg,&EbdaData->cdemu.load_segment);
- bootdrv = (Bit8u)(status>>8);
- }
-
-#endif // BX_ELTORITO_BOOT
-
- // We have to boot from harddisk or floppy
- if (bootcd == 0) {
- bootseg=0x07c0;
-
-ASM_START
- push bp
- mov bp, sp
-
- mov ax, #0x0000
- mov _int19_function.status + 2[bp], ax
- mov dl, _int19_function.bootdrv + 2[bp]
- mov ax, _int19_function.bootseg + 2[bp]
- mov es, ax ;; segment
- mov bx, #0x0000 ;; offset
- mov ah, #0x02 ;; function 2, read diskette sector
- mov al, #0x01 ;; read 1 sector
- mov ch, #0x00 ;; track 0
- mov cl, #0x01 ;; sector 1
- mov dh, #0x00 ;; head 0
- int #0x13 ;; read sector
- jnc int19_load_done
- mov ax, #0x0001
- mov _int19_function.status + 2[bp], ax
-
-int19_load_done:
- pop bp
-ASM_END
-
- if (status != 0) {
- print_boot_failure(bootcd, bootdrv, 1, lastdrive);
- return 0x00000000;
- }
- }
-
- // check signature if instructed by cmos reg 0x38, only for floppy
- // bootchk = 1 : signature check disabled
- // bootchk = 0 : signature check enabled
- if (bootdrv != 0) bootchk = 0;
- else bootchk = inb_cmos(0x38) & 0x01;
-
-#if BX_ELTORITO_BOOT
- // if boot from cd, no signature check
- if (bootcd != 0)
- bootchk = 1;
-#endif // BX_ELTORITO_BOOT
-
- if (bootchk == 0) {
- if (read_word(bootseg,0x1fe) != 0xaa55) {
- print_boot_failure(bootcd, bootdrv, 0, lastdrive);
- return 0x00000000;
- }
- }
-
-#if BX_ELTORITO_BOOT
- // Print out the boot string
- print_boot_device(bootcd, bootdrv);
-#else // BX_ELTORITO_BOOT
- print_boot_device(0, bootdrv);
-#endif // BX_ELTORITO_BOOT
-
- // return the boot segment
- return (((Bit32u)bootdrv) << 16) + bootseg;
-}
-
- void
-int1a_function(regs, ds, iret_addr)
- pusha_regs_t regs; // regs pushed from PUSHA instruction
- Bit16u ds; // previous DS:, DS set to 0x0000 by asm wrapper
- iret_addr_t iret_addr; // CS,IP,Flags pushed from original INT call
-{
- Bit8u val8;
-
- BX_DEBUG_INT1A("int1a: AX=%04x BX=%04x CX=%04x DX=%04x DS=%04x\n", regs.u.r16.ax, regs.u.r16.bx, regs.u.r16.cx, regs.u.r16.dx, ds);
-
- ASM_START
- sti
- ASM_END
-
- switch (regs.u.r8.ah) {
- case 0: // get current clock count
- ASM_START
- cli
- ASM_END
- regs.u.r16.cx = BiosData->ticks_high;
- regs.u.r16.dx = BiosData->ticks_low;
- regs.u.r8.al = BiosData->midnight_flag;
- BiosData->midnight_flag = 0; // reset flag
- ASM_START
- sti
- ASM_END
- // AH already 0
- ClearCF(iret_addr.flags); // OK
- break;
-
- case 1: // Set Current Clock Count
- ASM_START
- cli
- ASM_END
- BiosData->ticks_high = regs.u.r16.cx;
- BiosData->ticks_low = regs.u.r16.dx;
- BiosData->midnight_flag = 0; // reset flag
- ASM_START
- sti
- ASM_END
- regs.u.r8.ah = 0;
- ClearCF(iret_addr.flags); // OK
- break;
-
-
- case 2: // Read CMOS Time
- if (rtc_updating()) {
- SetCF(iret_addr.flags);
- break;
- }
-
- regs.u.r8.dh = inb_cmos(0x00); // Seconds
- regs.u.r8.cl = inb_cmos(0x02); // Minutes
- regs.u.r8.ch = inb_cmos(0x04); // Hours
- regs.u.r8.dl = inb_cmos(0x0b) & 0x01; // Stat Reg B
- regs.u.r8.ah = 0;
- regs.u.r8.al = regs.u.r8.ch;
- ClearCF(iret_addr.flags); // OK
- break;
-
- case 3: // Set CMOS Time
- // Using a debugger, I notice the following masking/setting
- // of bits in Status Register B, by setting Reg B to
- // a few values and getting its value after INT 1A was called.
- //
- // try#1 try#2 try#3
- // before 1111 1101 0111 1101 0000 0000
- // after 0110 0010 0110 0010 0000 0010
- //
- // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1
- // My assumption: RegB = ((RegB & 01100000b) | 00000010b)
- if (rtc_updating()) {
- init_rtc();
- // fall through as if an update were not in progress
- }
- outb_cmos(0x00, regs.u.r8.dh); // Seconds
- outb_cmos(0x02, regs.u.r8.cl); // Minutes
- outb_cmos(0x04, regs.u.r8.ch); // Hours
- // Set Daylight Savings time enabled bit to requested value
- val8 = (inb_cmos(0x0b) & 0x60) | 0x02 | (regs.u.r8.dl & 0x01);
- // (reg B already selected)
- outb_cmos(0x0b, val8);
- regs.u.r8.ah = 0;
- regs.u.r8.al = val8; // val last written to Reg B
- ClearCF(iret_addr.flags); // OK
- break;
-
- case 4: // Read CMOS Date
- regs.u.r8.ah = 0;
- if (rtc_updating()) {
- SetCF(iret_addr.flags);
- break;
- }
- regs.u.r8.cl = inb_cmos(0x09); // Year
- regs.u.r8.dh = inb_cmos(0x08); // Month
- regs.u.r8.dl = inb_cmos(0x07); // Day of Month
- regs.u.r8.ch = inb_cmos(0x32); // Century
- regs.u.r8.al = regs.u.r8.ch;
- ClearCF(iret_addr.flags); // OK
- break;
-
- case 5: // Set CMOS Date
- // Using a debugger, I notice the following masking/setting
- // of bits in Status Register B, by setting Reg B to
- // a few values and getting its value after INT 1A was called.
- //
- // try#1 try#2 try#3 try#4
- // before 1111 1101 0111 1101 0000 0010 0000 0000
- // after 0110 1101 0111 1101 0000 0010 0000 0000
- //
- // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1
- // My assumption: RegB = (RegB & 01111111b)
- if (rtc_updating()) {
- init_rtc();
- SetCF(iret_addr.flags);
- break;
- }
- outb_cmos(0x09, regs.u.r8.cl); // Year
- outb_cmos(0x08, regs.u.r8.dh); // Month
- outb_cmos(0x07, regs.u.r8.dl); // Day of Month
- outb_cmos(0x32, regs.u.r8.ch); // Century
- val8 = inb_cmos(0x0b) & 0x7f; // clear halt-clock bit
- outb_cmos(0x0b, val8);
- regs.u.r8.ah = 0;
- regs.u.r8.al = val8; // AL = val last written to Reg B
- ClearCF(iret_addr.flags); // OK
- break;
-
- case 6: // Set Alarm Time in CMOS
- // Using a debugger, I notice the following masking/setting
- // of bits in Status Register B, by setting Reg B to
- // a few values and getting its value after INT 1A was called.
- //
- // try#1 try#2 try#3
- // before 1101 1111 0101 1111 0000 0000
- // after 0110 1111 0111 1111 0010 0000
- //
- // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1
- // My assumption: RegB = ((RegB & 01111111b) | 00100000b)
- val8 = inb_cmos(0x0b); // Get Status Reg B
- regs.u.r16.ax = 0;
- if (val8 & 0x20) {
- // Alarm interrupt enabled already
- SetCF(iret_addr.flags); // Error: alarm in use
- break;
- }
- if (rtc_updating()) {
- init_rtc();
- // fall through as if an update were not in progress
- }
- outb_cmos(0x01, regs.u.r8.dh); // Seconds alarm
- outb_cmos(0x03, regs.u.r8.cl); // Minutes alarm
- outb_cmos(0x05, regs.u.r8.ch); // Hours alarm
- outb(0xa1, inb(0xa1) & 0xfe); // enable IRQ 8
- // enable Status Reg B alarm bit, clear halt clock bit
- outb_cmos(0x0b, (val8 & 0x7f) | 0x20);
- ClearCF(iret_addr.flags); // OK
- break;
-
- case 7: // Turn off Alarm
- // Using a debugger, I notice the following masking/setting
- // of bits in Status Register B, by setting Reg B to
- // a few values and getting its value after INT 1A was called.
- //
- // try#1 try#2 try#3 try#4
- // before 1111 1101 0111 1101 0010 0000 0010 0010
- // after 0100 0101 0101 0101 0000 0000 0000 0010
- //
- // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1
- // My assumption: RegB = (RegB & 01010111b)
- val8 = inb_cmos(0x0b); // Get Status Reg B
- // clear clock-halt bit, disable alarm bit
- outb_cmos(0x0b, val8 & 0x57); // disable alarm bit
- regs.u.r8.ah = 0;
- regs.u.r8.al = val8; // val last written to Reg B
- ClearCF(iret_addr.flags); // OK
- break;
-#if BX_PCIBIOS
- case 0xb1:
- // real mode PCI BIOS functions now handled in assembler code
- // this C code handles the error code for information only
- if (regs.u.r8.bl == 0xff) {
- BX_INFO("PCI BIOS: PCI not present\n");
- } else if (regs.u.r8.bl == 0x81) {
- BX_INFO("unsupported PCI BIOS function 0x%02x\n", regs.u.r8.al);
- } else if (regs.u.r8.bl == 0x83) {
- BX_INFO("bad PCI vendor ID %04x\n", regs.u.r16.dx);
- } else if (regs.u.r8.bl == 0x86) {
- BX_INFO("PCI device %04x:%04x not found at index %d\n", regs.u.r16.dx, regs.u.r16.cx, regs.u.r16.si);
- }
- regs.u.r8.ah = regs.u.r8.bl;
- SetCF(iret_addr.flags);
- break;
-#endif
-
- default:
- SetCF(iret_addr.flags); // Unsupported
- }
-}
-
- void
-int70_function(regs, ds, iret_addr)
- pusha_regs_t regs; // regs pushed from PUSHA instruction
- Bit16u ds; // previous DS:, DS set to 0x0000 by asm wrapper
- iret_addr_t iret_addr; // CS,IP,Flags pushed from original INT call
-{
- // INT 70h: IRQ 8 - CMOS RTC interrupt from periodic or alarm modes
- Bit8u registerB = 0, registerC = 0;
-
- // Check which modes are enabled and have occurred.
- registerB = inb_cmos( 0xB );
- registerC = inb_cmos( 0xC );
-
- if( ( registerB & 0x60 ) != 0 ) {
- if( ( registerC & 0x20 ) != 0 ) {
- // Handle Alarm Interrupt.
-ASM_START
- sti
- int #0x4a
- cli
-ASM_END
- }
- if( ( registerC & 0x40 ) != 0 ) {
- // Handle Periodic Interrupt.
-
- if( read_byte( 0x40, 0xA0 ) != 0 ) {
- // Wait Interval (Int 15, AH=83) active.
- Bit32u time, toggle;
-
- time = read_dword( 0x40, 0x9C ); // Time left in microseconds.
- if( time < 0x3D1 ) {
- // Done waiting.
- Bit16u segment, offset;
-
- segment = read_word( 0x40, 0x98 );
- offset = read_word( 0x40, 0x9A );
- write_byte( 0x40, 0xA0, 0 ); // Turn of status byte.
- outb_cmos( 0xB, registerB & 0x37 ); // Clear the Periodic Interrupt.
- write_byte(segment, offset, read_byte(segment, offset) | 0x80 ); // Write to specified flag byte.
- } else {
- // Continue waiting.
- time -= 0x3D1;
- write_dword( 0x40, 0x9C, time );
- }
- }
- }
- }
-
-ASM_START
- call eoi_both_pics
-ASM_END
-}
-
-
-ASM_START
-;------------------------------------------
-;- INT74h : PS/2 mouse hardware interrupt -
-;------------------------------------------
-int74_handler:
- sti
- pusha
- push ds ;; save DS
- push #0x00 ;; placeholder for status
- push #0x00 ;; placeholder for X
- push #0x00 ;; placeholder for Y
- push #0x00 ;; placeholder for Z
- push #0x00 ;; placeholder for make_far_call boolean
- call _int74_function
- pop cx ;; remove make_far_call from stack
- jcxz int74_done
-
- ;; make far call to EBDA:0022
- push #0x00
- pop ds
- push 0x040E ;; push 0000:040E (opcodes 0xff, 0x36, 0x0E, 0x04)
- pop ds
- //CALL_EP(0x0022) ;; call far routine (call_Ep DS:0022 :opcodes 0xff, 0x1e, 0x22, 0x00)
- call far ptr[0x22]
-int74_done:
- cli
- call eoi_both_pics
- add sp, #8 ;; pop status, x, y, z
-
- pop ds ;; restore DS
- popa
- iret
-
-
-;; This will perform an IRET, but will retain value of current CF
-;; by altering flags on stack. Better than RETF #02.
-iret_modify_cf:
- jc carry_set
- push bp
- mov bp, sp
- and BYTE [bp + 0x06], #0xfe
- pop bp
- iret
-carry_set:
- push bp
- mov bp, sp
- or BYTE [bp + 0x06], #0x01
- pop bp
- iret
-
-
-;----------------------
-;- INT13h (relocated) -
-;----------------------
-;
-; int13_relocated is a little bit messed up since I played with it
-; I have to rewrite it:
-; - call a function that detect which function to call
-; - make all called C function get the same parameters list
-;
-int13_relocated:
-
-#if BX_ELTORITO_BOOT
- ;; check for an eltorito function
- cmp ah,#0x4a
- jb int13_not_eltorito
- cmp ah,#0x4d
- ja int13_not_eltorito
-
- pusha
- push es
- push ds
- push ss
- pop ds
-
- push #int13_out
- jmp _int13_eltorito ;; ELDX not used
-
-int13_not_eltorito:
- push ax
- push bx
- push cx
- push dx
-
- ;; check if emulation active
- call _cdemu_isactive
- cmp al,#0x00
- je int13_cdemu_inactive
-
- ;; check if access to the emulated drive
- call _cdemu_emulated_drive
- pop dx
- push dx
- cmp al,dl ;; int13 on emulated drive
- jne int13_nocdemu
-
- pop dx
- pop cx
- pop bx
- pop ax
-
- pusha
- push es
- push ds
- push ss
- pop ds
-
- push #int13_out
- jmp _int13_cdemu ;; ELDX not used
-
-int13_nocdemu:
- and dl,#0xE0 ;; mask to get device class, including cdroms
- cmp al,dl ;; al is 0x00 or 0x80
- jne int13_cdemu_inactive ;; inactive for device class
-
- pop dx
- pop cx
- pop bx
- pop ax
-
- push ax
- push cx
- push dx
- push bx
-
- dec dl ;; real drive is dl - 1
- jmp int13_legacy
-
-int13_cdemu_inactive:
- pop dx
- pop cx
- pop bx
- pop ax
-
-#endif // BX_ELTORITO_BOOT
-
-int13_noeltorito:
-
- push ax
- push cx
- push dx
- push bx
-
-int13_legacy:
-
- push dx ;; push eltorito value of dx instead of sp
-
- push bp
- push si
- push di
-
- push es
- push ds
- push ss
- pop ds
-
- ;; now the 16-bit registers can be restored with:
- ;; pop ds; pop es; popa; iret
- ;; arguments passed to functions should be
- ;; DS, ES, DI, SI, BP, ELDX, BX, DX, CX, AX, IP, CS, FLAGS
-
- test dl, #0x80
- jnz int13_notfloppy
-
- push #int13_out
- jmp _int13_diskette_function
-
-int13_notfloppy:
-
-#if BX_USE_ATADRV
-
- cmp dl, #0xE0
- jb int13_notcdrom
-
- // ebx is modified: BSD 5.2.1 boot loader problem
- // someone should figure out which 32 bit register that actually are used
-
- shr ebx, #16
- push bx
-
- call _int13_cdrom
-
- pop bx
- shl ebx, #16
-
- jmp int13_out
-
-int13_notcdrom:
-
-#endif
-
-int13_disk:
- call _int13_harddisk
-
-int13_out:
- pop ds
- pop es
- popa
- iret
-
-
-;----------
-;- INT18h -
-;----------
-int18_handler: ;; Boot Failure routing
- call _int18_panic_msg
- hlt
- iret
-
-;----------
-;- INT19h -
-;----------
-int19_relocated: ;; Boot function, relocated
-
- ;; int19 was beginning to be really complex, so now it
- ;; just calls an C function, that does the work
- ;; it returns in BL the boot drive, and in AX the boot segment
- ;; the boot segment will be 0x0000 if something has failed
-
- push bp
- mov bp, sp
-
- ;; drop ds
- xor ax, ax
- mov ds, ax
-
- ;; 1st boot device
- mov ax, #0x0001
- push ax
- call _int19_function
- inc sp
- inc sp
- ;; bl contains the boot drive
- ;; ax contains the boot segment or 0 if failure
-
- test ax, ax ;; if ax is 0 try next boot device
- jnz boot_setup
-
- ;; 2nd boot device
- mov ax, #0x0002
- push ax
- call _int19_function
- inc sp
- inc sp
- test ax, ax ;; if ax is 0 try next boot device
- jnz boot_setup
-
- ;; 3rd boot device
- mov ax, #0x0003
- push ax
- call _int19_function
- inc sp
- inc sp
- test ax, ax ;; if ax is 0 call int18
- jz int18_handler
-
-boot_setup:
- mov dl, bl ;; set drive so guest os find it
- shl eax, #0x04 ;; convert seg to ip
- mov 2[bp], ax ;; set ip
-
- shr eax, #0x04 ;; get cs back
- and ax, #0xF000 ;; remove what went in ip
- mov 4[bp], ax ;; set cs
- xor ax, ax
- mov es, ax ;; set es to zero fixes [ 549815 ]
- mov [bp], ax ;; set bp to zero
- mov ax, #0xaa55 ;; set ok flag
-
- pop bp
- iret ;; Beam me up Scotty
-
-;----------
-;- INT1Ch -
-;----------
-int1c_handler: ;; User Timer Tick
- iret
-
-
-;----------------------
-;- POST: Floppy Drive -
-;----------------------
-floppy_drive_post:
- mov ax, #0x0000
- mov ds, ax
-
- mov al, #0x00
- mov 0x043e, al ;; drive 0 & 1 uncalibrated, no interrupt has occurred
-
- mov 0x043f, al ;; diskette motor status: read op, drive0, motors off
-
- mov 0x0440, al ;; diskette motor timeout counter: not active
- mov 0x0441, al ;; diskette controller status return code
-
- mov 0x0442, al ;; disk & diskette controller status register 0
- mov 0x0443, al ;; diskette controller status register 1
- mov 0x0444, al ;; diskette controller status register 2
- mov 0x0445, al ;; diskette controller cylinder number
- mov 0x0446, al ;; diskette controller head number
- mov 0x0447, al ;; diskette controller sector number
- mov 0x0448, al ;; diskette controller bytes written
-
- mov 0x048b, al ;; diskette configuration data
-
- ;; -----------------------------------------------------------------
- ;; (048F) diskette controller information
- ;;
- mov al, #0x10 ;; get CMOS diskette drive type
- out 0x70, AL
- in AL, 0x71
- mov ah, al ;; save byte to AH
-
-look_drive0:
- shr al, #4 ;; look at top 4 bits for drive 0
- jz f0_missing ;; jump if no drive0
- mov bl, #0x07 ;; drive0 determined, multi-rate, has changed line
- jmp look_drive1
-f0_missing:
- mov bl, #0x00 ;; no drive0
-
-look_drive1:
- mov al, ah ;; restore from AH
- and al, #0x0f ;; look at bottom 4 bits for drive 1
- jz f1_missing ;; jump if no drive1
- or bl, #0x70 ;; drive1 determined, multi-rate, has changed line
-f1_missing:
- ;; leave high bits in BL zerod
- mov 0x048f, bl ;; put new val in BDA (diskette controller information)
- ;; -----------------------------------------------------------------
-
- mov al, #0x00
- mov 0x0490, al ;; diskette 0 media state
- mov 0x0491, al ;; diskette 1 media state
-
- ;; diskette 0,1 operational starting state
- ;; drive type has not been determined,
- ;; has no changed detection line
- mov 0x0492, al
- mov 0x0493, al
-
- mov 0x0494, al ;; diskette 0 current cylinder
- mov 0x0495, al ;; diskette 1 current cylinder
-
- mov al, #0x02
- out #0x0a, al ;; clear DMA-1 channel 2 mask bit
-
- SET_INT_VECTOR(0x1E, #0xF000, #diskette_param_table2)
- SET_INT_VECTOR(0x40, #0xF000, #int13_diskette)
- SET_INT_VECTOR(0x0E, #0xF000, #int0e_handler) ;; IRQ 6
-
- ret
-
-
-;--------------------
-;- POST: HARD DRIVE -
-;--------------------
-; relocated here because the primary POST area isnt big enough.
-hard_drive_post:
- // IRQ 14 = INT 76h
- // INT 76h calls INT 15h function ax=9100
-
- mov al, #0x0a ; 0000 1010 = reserved, disable IRQ 14
- mov dx, #0x03f6
- out dx, al
-
- mov ax, #0x0000
- mov ds, ax
- mov 0x0474, al /* hard disk status of last operation */
- mov 0x0477, al /* hard disk port offset (XT only ???) */
- mov 0x048c, al /* hard disk status register */
- mov 0x048d, al /* hard disk error register */
- mov 0x048e, al /* hard disk task complete flag */
- mov al, #0x01
- mov 0x0475, al /* hard disk number attached */
- mov al, #0xc0
- mov 0x0476, al /* hard disk control byte */
- SET_INT_VECTOR(0x13, #0xF000, #int13_handler)
- SET_INT_VECTOR(0x76, #0xF000, #int76_handler)
- ;; INT 41h: hard disk 0 configuration pointer
- ;; INT 46h: hard disk 1 configuration pointer
- SET_INT_VECTOR(0x41, #EBDA_SEG, #0x003D)
- SET_INT_VECTOR(0x46, #EBDA_SEG, #0x004D)
-
- ;; move disk geometry data from CMOS to EBDA disk parameter table(s)
- mov al, #0x12
- out #0x70, al
- in al, #0x71
- and al, #0xf0
- cmp al, #0xf0
- je post_d0_extended
- jmp check_for_hd1
-post_d0_extended:
- mov al, #0x19
- out #0x70, al
- in al, #0x71
- cmp al, #47 ;; decimal 47 - user definable
- je post_d0_type47
- HALT(__LINE__)
-post_d0_type47:
- ;; CMOS purpose param table offset
- ;; 1b cylinders low 0
- ;; 1c cylinders high 1
- ;; 1d heads 2
- ;; 1e write pre-comp low 5
- ;; 1f write pre-comp high 6
- ;; 20 retries/bad map/heads>8 8
- ;; 21 landing zone low C
- ;; 22 landing zone high D
- ;; 23 sectors/track E
-
- mov ax, #EBDA_SEG
- mov ds, ax
-
- ;;; Filling EBDA table for hard disk 0.
- mov al, #0x1f
- out #0x70, al
- in al, #0x71
- mov ah, al
- mov al, #0x1e
- out #0x70, al
- in al, #0x71
- mov (0x003d + 0x05), ax ;; write precomp word
-
- mov al, #0x20
- out #0x70, al
- in al, #0x71
- mov (0x003d + 0x08), al ;; drive control byte
-
- mov al, #0x22
- out #0x70, al
- in al, #0x71
- mov ah, al
- mov al, #0x21
- out #0x70, al
- in al, #0x71
- mov (0x003d + 0x0C), ax ;; landing zone word
-
- mov al, #0x1c ;; get cylinders word in AX
- out #0x70, al
- in al, #0x71 ;; high byte
- mov ah, al
- mov al, #0x1b
- out #0x70, al
- in al, #0x71 ;; low byte
- mov bx, ax ;; BX = cylinders
-
- mov al, #0x1d
- out #0x70, al
- in al, #0x71
- mov cl, al ;; CL = heads
-
- mov al, #0x23
- out #0x70, al
- in al, #0x71
- mov dl, al ;; DL = sectors
-
- cmp bx, #1024
- jnbe hd0_post_logical_chs ;; if cylinders > 1024, use translated style CHS
-
-hd0_post_physical_chs:
- ;; no logical CHS mapping used, just physical CHS
- ;; use Standard Fixed Disk Parameter Table (FDPT)
- mov (0x003d + 0x00), bx ;; number of physical cylinders
- mov (0x003d + 0x02), cl ;; number of physical heads
- mov (0x003d + 0x0E), dl ;; number of physical sectors
- jmp check_for_hd1
-
-hd0_post_logical_chs:
- ;; complies with Phoenix style Translated Fixed Disk Parameter Table (FDPT)
- mov (0x003d + 0x09), bx ;; number of physical cylinders
- mov (0x003d + 0x0b), cl ;; number of physical heads
- mov (0x003d + 0x04), dl ;; number of physical sectors
- mov (0x003d + 0x0e), dl ;; number of logical sectors (same)
- mov al, #0xa0
- mov (0x003d + 0x03), al ;; A0h signature, indicates translated table
-
- cmp bx, #2048
- jnbe hd0_post_above_2048
- ;; 1024 < c <= 2048 cylinders
- shr bx, #0x01
- shl cl, #0x01
- jmp hd0_post_store_logical
-
-hd0_post_above_2048:
- cmp bx, #4096
- jnbe hd0_post_above_4096
- ;; 2048 < c <= 4096 cylinders
- shr bx, #0x02
- shl cl, #0x02
- jmp hd0_post_store_logical
-
-hd0_post_above_4096:
- cmp bx, #8192
- jnbe hd0_post_above_8192
- ;; 4096 < c <= 8192 cylinders
- shr bx, #0x03
- shl cl, #0x03
- jmp hd0_post_store_logical
-
-hd0_post_above_8192:
- ;; 8192 < c <= 16384 cylinders
- shr bx, #0x04
- shl cl, #0x04
-
-hd0_post_store_logical:
- mov (0x003d + 0x00), bx ;; number of physical cylinders
- mov (0x003d + 0x02), cl ;; number of physical heads
- ;; checksum
- mov cl, #0x0f ;; repeat count
- mov si, #0x003d ;; offset to disk0 FDPT
- mov al, #0x00 ;; sum
-hd0_post_checksum_loop:
- add al, [si]
- inc si
- dec cl
- jnz hd0_post_checksum_loop
- not al ;; now take 2s complement
- inc al
- mov [si], al
-;;; Done filling EBDA table for hard disk 0.
-
-
-check_for_hd1:
- ;; is there really a second hard disk? if not, return now
- mov al, #0x12
- out #0x70, al
- in al, #0x71
- and al, #0x0f
- jnz post_d1_exists
- ret
-post_d1_exists:
- ;; check that the hd type is really 0x0f.
- cmp al, #0x0f
- jz post_d1_extended
- HALT(__LINE__)
-post_d1_extended:
- ;; check that the extended type is 47 - user definable
- mov al, #0x1a
- out #0x70, al
- in al, #0x71
- cmp al, #47 ;; decimal 47 - user definable
- je post_d1_type47
- HALT(__LINE__)
-post_d1_type47:
- ;; Table for disk1.
- ;; CMOS purpose param table offset
- ;; 0x24 cylinders low 0
- ;; 0x25 cylinders high 1
- ;; 0x26 heads 2
- ;; 0x27 write pre-comp low 5
- ;; 0x28 write pre-comp high 6
- ;; 0x29 heads>8 8
- ;; 0x2a landing zone low C
- ;; 0x2b landing zone high D
- ;; 0x2c sectors/track E
-;;; Fill EBDA table for hard disk 1.
- mov ax, #EBDA_SEG
- mov ds, ax
- mov al, #0x28
- out #0x70, al
- in al, #0x71
- mov ah, al
- mov al, #0x27
- out #0x70, al
- in al, #0x71
- mov (0x004d + 0x05), ax ;; write precomp word
-
- mov al, #0x29
- out #0x70, al
- in al, #0x71
- mov (0x004d + 0x08), al ;; drive control byte
-
- mov al, #0x2b
- out #0x70, al
- in al, #0x71
- mov ah, al
- mov al, #0x2a
- out #0x70, al
- in al, #0x71
- mov (0x004d + 0x0C), ax ;; landing zone word
-
- mov al, #0x25 ;; get cylinders word in AX
- out #0x70, al
- in al, #0x71 ;; high byte
- mov ah, al
- mov al, #0x24
- out #0x70, al
- in al, #0x71 ;; low byte
- mov bx, ax ;; BX = cylinders
-
- mov al, #0x26
- out #0x70, al
- in al, #0x71
- mov cl, al ;; CL = heads
-
- mov al, #0x2c
- out #0x70, al
- in al, #0x71
- mov dl, al ;; DL = sectors
-
- cmp bx, #1024
- jnbe hd1_post_logical_chs ;; if cylinders > 1024, use translated style CHS
-
-hd1_post_physical_chs:
- ;; no logical CHS mapping used, just physical CHS
- ;; use Standard Fixed Disk Parameter Table (FDPT)
- mov (0x004d + 0x00), bx ;; number of physical cylinders
- mov (0x004d + 0x02), cl ;; number of physical heads
- mov (0x004d + 0x0E), dl ;; number of physical sectors
- ret
-
-hd1_post_logical_chs:
- ;; complies with Phoenix style Translated Fixed Disk Parameter Table (FDPT)
- mov (0x004d + 0x09), bx ;; number of physical cylinders
- mov (0x004d + 0x0b), cl ;; number of physical heads
- mov (0x004d + 0x04), dl ;; number of physical sectors
- mov (0x004d + 0x0e), dl ;; number of logical sectors (same)
- mov al, #0xa0
- mov (0x004d + 0x03), al ;; A0h signature, indicates translated table
-
- cmp bx, #2048
- jnbe hd1_post_above_2048
- ;; 1024 < c <= 2048 cylinders
- shr bx, #0x01
- shl cl, #0x01
- jmp hd1_post_store_logical
-
-hd1_post_above_2048:
- cmp bx, #4096
- jnbe hd1_post_above_4096
- ;; 2048 < c <= 4096 cylinders
- shr bx, #0x02
- shl cl, #0x02
- jmp hd1_post_store_logical
-
-hd1_post_above_4096:
- cmp bx, #8192
- jnbe hd1_post_above_8192
- ;; 4096 < c <= 8192 cylinders
- shr bx, #0x03
- shl cl, #0x03
- jmp hd1_post_store_logical
-
-hd1_post_above_8192:
- ;; 8192 < c <= 16384 cylinders
- shr bx, #0x04
- shl cl, #0x04
-
-hd1_post_store_logical:
- mov (0x004d + 0x00), bx ;; number of physical cylinders
- mov (0x004d + 0x02), cl ;; number of physical heads
- ;; checksum
- mov cl, #0x0f ;; repeat count
- mov si, #0x004d ;; offset to disk0 FDPT
- mov al, #0x00 ;; sum
-hd1_post_checksum_loop:
- add al, [si]
- inc si
- dec cl
- jnz hd1_post_checksum_loop
- not al ;; now take 2s complement
- inc al
- mov [si], al
-;;; Done filling EBDA table for hard disk 1.
-
- ret
-
-;--------------------
-;- POST: EBDA segment
-;--------------------
-; relocated here because the primary POST area isnt big enough.
-ebda_post:
-#if BX_USE_EBDA
- mov ax, #EBDA_SEG
- mov ds, ax
- mov byte ptr [0x0], #EBDA_SIZE
-#endif
- xor ax, ax ; mov EBDA seg into 40E
- mov ds, ax
- mov word ptr [0x40E], #EBDA_SEG
- ret;;
-
-;--------------------
-;- POST: EOI + jmp via [0x40:67)
-;--------------------
-; relocated here because the primary POST area isnt big enough.
-eoi_jmp_post:
- call eoi_both_pics
-
- xor ax, ax
- mov ds, ax
-
- jmp far ptr [0x467]
-
-
-;--------------------
-eoi_both_pics:
- mov al, #0x20
- out #0xA0, al ;; slave PIC EOI
-eoi_master_pic:
- mov al, #0x20
- out #0x20, al ;; master PIC EOI
- ret
-
-;--------------------
-BcdToBin:
- ;; in: AL in BCD format
- ;; out: AL in binary format, AH will always be 0
- ;; trashes BX
- mov bl, al
- and bl, #0x0f ;; bl has low digit
- shr al, #4 ;; al has high digit
- mov bh, #10
- mul al, bh ;; multiply high digit by 10 (result in AX)
- add al, bl ;; then add low digit
- ret
-
-;--------------------
-timer_tick_post:
- ;; Setup the Timer Ticks Count (0x46C:dword) and
- ;; Timer Ticks Roller Flag (0x470:byte)
- ;; The Timer Ticks Count needs to be set according to
- ;; the current CMOS time, as if ticks have been occurring
- ;; at 18.2hz since midnight up to this point. Calculating
- ;; this is a little complicated. Here are the factors I gather
- ;; regarding this. 14,318,180 hz was the original clock speed,
- ;; chosen so it could be divided by either 3 to drive the 5Mhz CPU
- ;; at the time, or 4 to drive the CGA video adapter. The div3
- ;; source was divided again by 4 to feed a 1.193Mhz signal to
- ;; the timer. With a maximum 16bit timer count, this is again
- ;; divided down by 65536 to 18.2hz.
- ;;
- ;; 14,318,180 Hz clock
- ;; /3 = 4,772,726 Hz fed to orginal 5Mhz CPU
- ;; /4 = 1,193,181 Hz fed to timer
- ;; /65536 (maximum timer count) = 18.20650736 ticks/second
- ;; 1 second = 18.20650736 ticks
- ;; 1 minute = 1092.390442 ticks
- ;; 1 hour = 65543.42651 ticks
- ;;
- ;; Given the values in the CMOS clock, one could calculate
- ;; the number of ticks by the following:
- ;; ticks = (BcdToBin(seconds) * 18.206507) +
- ;; (BcdToBin(minutes) * 1092.3904)
- ;; (BcdToBin(hours) * 65543.427)
- ;; To get a little more accuracy, since Im using integer
- ;; arithmatic, I use:
- ;; ticks = (BcdToBin(seconds) * 18206507) / 1000000 +
- ;; (BcdToBin(minutes) * 10923904) / 10000 +
- ;; (BcdToBin(hours) * 65543427) / 1000
-
- ;; assuming DS=0000
-
- ;; get CMOS seconds
- xor eax, eax ;; clear EAX
- mov al, #0x00
- out #0x70, al
- in al, #0x71 ;; AL has CMOS seconds in BCD
- call BcdToBin ;; EAX now has seconds in binary
- mov edx, #18206507
- mul eax, edx
- mov ebx, #1000000
- xor edx, edx
- div eax, ebx
- mov ecx, eax ;; ECX will accumulate total ticks
-
- ;; get CMOS minutes
- xor eax, eax ;; clear EAX
- mov al, #0x02
- out #0x70, al
- in al, #0x71 ;; AL has CMOS minutes in BCD
- call BcdToBin ;; EAX now has minutes in binary
- mov edx, #10923904
- mul eax, edx
- mov ebx, #10000
- xor edx, edx
- div eax, ebx
- add ecx, eax ;; add to total ticks
-
- ;; get CMOS hours
- xor eax, eax ;; clear EAX
- mov al, #0x04
- out #0x70, al
- in al, #0x71 ;; AL has CMOS hours in BCD
- call BcdToBin ;; EAX now has hours in binary
- mov edx, #65543427
- mul eax, edx
- mov ebx, #1000
- xor edx, edx
- div eax, ebx
- add ecx, eax ;; add to total ticks
-
- mov 0x46C, ecx ;; Timer Ticks Count
- xor al, al
- mov 0x470, al ;; Timer Ticks Rollover Flag
- ret
-
-;--------------------
-int76_handler:
- ;; record completion in BIOS task complete flag
- push ax
- push ds
- mov ax, #0x0040
- mov ds, ax
- mov 0x008E, #0xff
- call eoi_both_pics
- pop ds
- pop ax
- iret
-
-
-;--------------------
-
-;--------------------
-#if BX_PCIBIOS
-use32 386
-.align 16
-bios32_structure:
- db 0x5f, 0x33, 0x32, 0x5f ;; "_32_" signature
- dw bios32_entry_point, 0xf ;; 32 bit physical address
- db 0 ;; revision level
- ;; length in paragraphs and checksum stored in a word to prevent errors
- dw (~(((bios32_entry_point >> 8) + (bios32_entry_point & 0xff) + 0x32) \
- & 0xff) << 8) + 0x01
- db 0,0,0,0,0 ;; reserved
-
-.align 16
-bios32_entry_point:
- pushf
- cmp eax, #0x49435024 ;; "$PCI"
- jne unknown_service
- mov eax, #0x80000000
- mov dx, #0x0cf8
- out dx, eax
- mov dx, #0x0cfc
- in eax, dx
-#ifdef PCI_FIXED_HOST_BRIDGE
- cmp eax, #PCI_FIXED_HOST_BRIDGE
- jne unknown_service
-#else
- ;; say ok if a device is present
- cmp eax, #0xffffffff
- je unknown_service
-#endif
- mov ebx, #0x000f0000
- mov ecx, #0
- mov edx, #pcibios_protected
- xor al, al
- jmp bios32_end
-unknown_service:
- mov al, #0x80
-bios32_end:
- popf
- retf
-
-.align 16
-pcibios_protected:
- pushf
- cli
- push esi
- push edi
- cmp al, #0x01 ;; installation check
- jne pci_pro_f02
- mov bx, #0x0210
- mov cx, #0
- mov edx, #0x20494350 ;; "PCI "
- mov al, #0x01
- jmp pci_pro_ok
-pci_pro_f02: ;; find pci device
- cmp al, #0x02
- jne pci_pro_f08
- shl ecx, #16
- mov cx, dx
- mov bx, #0x0000
- mov di, #0x00
-pci_pro_devloop:
- call pci_pro_select_reg
- mov dx, #0x0cfc
- in eax, dx
- cmp eax, ecx
- jne pci_pro_nextdev
- cmp si, #0
- je pci_pro_ok
- dec si
-pci_pro_nextdev:
- inc bx
- cmp bx, #0x0100
- jne pci_pro_devloop
- mov ah, #0x86
- jmp pci_pro_fail
-pci_pro_f08: ;; read configuration byte
- cmp al, #0x08
- jne pci_pro_f09
- call pci_pro_select_reg
- push edx
- mov dx, di
- and dx, #0x03
- add dx, #0x0cfc
- in al, dx
- pop edx
- mov cl, al
- jmp pci_pro_ok
-pci_pro_f09: ;; read configuration word
- cmp al, #0x09
- jne pci_pro_f0a
- call pci_pro_select_reg
- push edx
- mov dx, di
- and dx, #0x02
- add dx, #0x0cfc
- in ax, dx
- pop edx
- mov cx, ax
- jmp pci_pro_ok
-pci_pro_f0a: ;; read configuration dword
- cmp al, #0x0a
- jne pci_pro_f0b
- call pci_pro_select_reg
- push edx
- mov dx, #0x0cfc
- in eax, dx
- pop edx
- mov ecx, eax
- jmp pci_pro_ok
-pci_pro_f0b: ;; write configuration byte
- cmp al, #0x0b
- jne pci_pro_f0c
- call pci_pro_select_reg
- push edx
- mov dx, di
- and dx, #0x03
- add dx, #0x0cfc
- mov al, cl
- out dx, al
- pop edx
- jmp pci_pro_ok
-pci_pro_f0c: ;; write configuration word
- cmp al, #0x0c
- jne pci_pro_f0d
- call pci_pro_select_reg
- push edx
- mov dx, di
- and dx, #0x02
- add dx, #0x0cfc
- mov ax, cx
- out dx, ax
- pop edx
- jmp pci_pro_ok
-pci_pro_f0d: ;; write configuration dword
- cmp al, #0x0d
- jne pci_pro_unknown
- call pci_pro_select_reg
- push edx
- mov dx, #0x0cfc
- mov eax, ecx
- out dx, eax
- pop edx
- jmp pci_pro_ok
-pci_pro_unknown:
- mov ah, #0x81
-pci_pro_fail:
- pop edi
- pop esi
- popf
- stc
- retf
-pci_pro_ok:
- xor ah, ah
- pop edi
- pop esi
- popf
- clc
- retf
-
-pci_pro_select_reg:
- push edx
- mov eax, #0x800000
- mov ax, bx
- shl eax, #8
- and di, #0xff
- or ax, di
- and al, #0xfc
- mov dx, #0x0cf8
- out dx, eax
- pop edx
- ret
-
-use16 386
-
-pcibios_real:
- push eax
- push dx
- mov eax, #0x80000000
- mov dx, #0x0cf8
- out dx, eax
- mov dx, #0x0cfc
- in eax, dx
-#ifdef PCI_FIXED_HOST_BRIDGE
- cmp eax, #PCI_FIXED_HOST_BRIDGE
- je pci_present
-#else
- ;; say ok if a device is present
- cmp eax, #0xffffffff
- jne pci_present
-#endif
- pop dx
- pop eax
- mov ah, #0xff
- stc
- ret
-pci_present:
- pop dx
- pop eax
- cmp al, #0x01 ;; installation check
- jne pci_real_f02
- mov ax, #0x0001
- mov bx, #0x0210
- mov cx, #0
- mov edx, #0x20494350 ;; "PCI "
- mov edi, #0xf0000
- mov di, #pcibios_protected
- clc
- ret
-pci_real_f02: ;; find pci device
- push esi
- push edi
- cmp al, #0x02
- jne pci_real_f08
- shl ecx, #16
- mov cx, dx
- mov bx, #0x0000
- mov di, #0x00
-pci_real_devloop:
- call pci_real_select_reg
- mov dx, #0x0cfc
- in eax, dx
- cmp eax, ecx
- jne pci_real_nextdev
- cmp si, #0
- je pci_real_ok
- dec si
-pci_real_nextdev:
- inc bx
- cmp bx, #0x0100
- jne pci_real_devloop
- mov dx, cx
- shr ecx, #16
- mov ah, #0x86
- jmp pci_real_fail
-pci_real_f08: ;; read configuration byte
- cmp al, #0x08
- jne pci_real_f09
- call pci_real_select_reg
- push dx
- mov dx, di
- and dx, #0x03
- add dx, #0x0cfc
- in al, dx
- pop dx
- mov cl, al
- jmp pci_real_ok
-pci_real_f09: ;; read configuration word
- cmp al, #0x09
- jne pci_real_f0a
- call pci_real_select_reg
- push dx
- mov dx, di
- and dx, #0x02
- add dx, #0x0cfc
- in ax, dx
- pop dx
- mov cx, ax
- jmp pci_real_ok
-pci_real_f0a: ;; read configuration dword
- cmp al, #0x0a
- jne pci_real_f0b
- call pci_real_select_reg
- push dx
- mov dx, #0x0cfc
- in eax, dx
- pop dx
- mov ecx, eax
- jmp pci_real_ok
-pci_real_f0b: ;; write configuration byte
- cmp al, #0x0b
- jne pci_real_f0c
- call pci_real_select_reg
- push dx
- mov dx, di
- and dx, #0x03
- add dx, #0x0cfc
- mov al, cl
- out dx, al
- pop dx
- jmp pci_real_ok
-pci_real_f0c: ;; write configuration word
- cmp al, #0x0c
- jne pci_real_f0d
- call pci_real_select_reg
- push dx
- mov dx, di
- and dx, #0x02
- add dx, #0x0cfc
- mov ax, cx
- out dx, ax
- pop dx
- jmp pci_real_ok
-pci_real_f0d: ;; write configuration dword
- cmp al, #0x0d
- jne pci_real_f0e
- call pci_real_select_reg
- push dx
- mov dx, #0x0cfc
- mov eax, ecx
- out dx, eax
- pop dx
- jmp pci_real_ok
-pci_real_f0e: ;; get irq routing options
- cmp al, #0x0e
- jne pci_real_unknown
- SEG ES
- cmp word ptr [di], #pci_routing_table_structure_end - pci_routing_table_structure_start
- jb pci_real_too_small
- SEG ES
- mov word ptr [di], #pci_routing_table_structure_end - pci_routing_table_structure_start
- pushf
- push ds
- push es
- push cx
- push si
- push di
- cld
- mov si, #pci_routing_table_structure_start
- push cs
- pop ds
- SEG ES
- mov cx, [di+2]
- SEG ES
- mov es, [di+4]
- mov di, cx
- mov cx, #pci_routing_table_structure_end - pci_routing_table_structure_start
- rep
- movsb
- pop di
- pop si
- pop cx
- pop es
- pop ds
- popf
- mov bx, #(1 << 9) | (1 << 11) ;; irq 9 and 11 are used
- jmp pci_real_ok
-pci_real_too_small:
- SEG ES
- mov word ptr [di], #pci_routing_table_structure_end - pci_routing_table_structure_start
- mov ah, #0x89
- jmp pci_real_fail
-
-pci_real_unknown:
- mov ah, #0x81
-pci_real_fail:
- pop edi
- pop esi
- stc
- ret
-pci_real_ok:
- xor ah, ah
- pop edi
- pop esi
- clc
- ret
-
-pci_real_select_reg:
- push dx
- mov eax, #0x800000
- mov ax, bx
- shl eax, #8
- and di, #0xff
- or ax, di
- and al, #0xfc
- mov dx, #0x0cf8
- out dx, eax
- pop dx
- ret
-
-.align 16
-pci_routing_table_structure:
- db 0x24, 0x50, 0x49, 0x52 ;; "$PIR" signature
- db 0, 1 ;; version
- dw 32 + (6 * 16) ;; table size
- db 0 ;; PCI interrupt router bus
- db 0x08 ;; PCI interrupt router DevFunc
- dw 0x0000 ;; PCI exclusive IRQs
- dw 0x8086 ;; compatible PCI interrupt router vendor ID
- dw 0x7000 ;; compatible PCI interrupt router device ID
- dw 0,0 ;; Miniport data
- db 0,0,0,0,0,0,0,0,0,0,0 ;; reserved
- db 0x07 ;; checksum
-pci_routing_table_structure_start:
- ;; first slot entry PCI-to-ISA (embedded)
- db 0 ;; pci bus number
- db 0x08 ;; pci device number (bit 7-3)
- db 0x60 ;; link value INTA#: pointer into PCI2ISA config space
- dw 0xdef8 ;; IRQ bitmap INTA#
- db 0x61 ;; link value INTB#
- dw 0xdef8 ;; IRQ bitmap INTB#
- db 0x62 ;; link value INTC#
- dw 0xdef8 ;; IRQ bitmap INTC#
- db 0x63 ;; link value INTD#
- dw 0xdef8 ;; IRQ bitmap INTD#
- db 0 ;; physical slot (0 = embedded)
- db 0 ;; reserved
- ;; second slot entry: 1st PCI slot
- db 0 ;; pci bus number
- db 0x10 ;; pci device number (bit 7-3)
- db 0x61 ;; link value INTA#
- dw 0xdef8 ;; IRQ bitmap INTA#
- db 0x62 ;; link value INTB#
- dw 0xdef8 ;; IRQ bitmap INTB#
- db 0x63 ;; link value INTC#
- dw 0xdef8 ;; IRQ bitmap INTC#
- db 0x60 ;; link value INTD#
- dw 0xdef8 ;; IRQ bitmap INTD#
- db 1 ;; physical slot (0 = embedded)
- db 0 ;; reserved
- ;; third slot entry: 2nd PCI slot
- db 0 ;; pci bus number
- db 0x18 ;; pci device number (bit 7-3)
- db 0x62 ;; link value INTA#
- dw 0xdef8 ;; IRQ bitmap INTA#
- db 0x63 ;; link value INTB#
- dw 0xdef8 ;; IRQ bitmap INTB#
- db 0x60 ;; link value INTC#
- dw 0xdef8 ;; IRQ bitmap INTC#
- db 0x61 ;; link value INTD#
- dw 0xdef8 ;; IRQ bitmap INTD#
- db 2 ;; physical slot (0 = embedded)
- db 0 ;; reserved
- ;; 4th slot entry: 3rd PCI slot
- db 0 ;; pci bus number
- db 0x20 ;; pci device number (bit 7-3)
- db 0x63 ;; link value INTA#
- dw 0xdef8 ;; IRQ bitmap INTA#
- db 0x60 ;; link value INTB#
- dw 0xdef8 ;; IRQ bitmap INTB#
- db 0x61 ;; link value INTC#
- dw 0xdef8 ;; IRQ bitmap INTC#
- db 0x62 ;; link value INTD#
- dw 0xdef8 ;; IRQ bitmap INTD#
- db 3 ;; physical slot (0 = embedded)
- db 0 ;; reserved
- ;; 5th slot entry: 4rd PCI slot
- db 0 ;; pci bus number
- db 0x28 ;; pci device number (bit 7-3)
- db 0x60 ;; link value INTA#
- dw 0xdef8 ;; IRQ bitmap INTA#
- db 0x61 ;; link value INTB#
- dw 0xdef8 ;; IRQ bitmap INTB#
- db 0x62 ;; link value INTC#
- dw 0xdef8 ;; IRQ bitmap INTC#
- db 0x63 ;; link value INTD#
- dw 0xdef8 ;; IRQ bitmap INTD#
- db 4 ;; physical slot (0 = embedded)
- db 0 ;; reserved
- ;; 6th slot entry: 5rd PCI slot
- db 0 ;; pci bus number
- db 0x30 ;; pci device number (bit 7-3)
- db 0x61 ;; link value INTA#
- dw 0xdef8 ;; IRQ bitmap INTA#
- db 0x62 ;; link value INTB#
- dw 0xdef8 ;; IRQ bitmap INTB#
- db 0x63 ;; link value INTC#
- dw 0xdef8 ;; IRQ bitmap INTC#
- db 0x60 ;; link value INTD#
- dw 0xdef8 ;; IRQ bitmap INTD#
- db 5 ;; physical slot (0 = embedded)
- db 0 ;; reserved
-pci_routing_table_structure_end:
-
-pci_irq_list:
- db 11, 10, 9, 5;
-
-pcibios_init_sel_reg:
- push eax
- mov eax, #0x800000
- mov ax, bx
- shl eax, #8
- and dl, #0xfc
- or al, dl
- mov dx, #0x0cf8
- out dx, eax
- pop eax
- ret
-
-pcibios_init_iomem_bases:
- push bp
- mov bp, sp
- mov eax, #0xe0000000 ;; base for memory init
- push eax
- mov ax, #0xc000 ;; base for i/o init
- push ax
- mov ax, #0x0010 ;; start at base address #0
- push ax
- mov bx, #0x0008
-pci_init_io_loop1:
- mov dl, #0x00
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- in ax, dx
- cmp ax, #0xffff
- jz next_pci_dev
- mov dl, #0x04 ;; disable i/o and memory space access
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- in al, dx
- and al, #0xfc
- out dx, al
-pci_init_io_loop2:
- mov dl, [bp-8]
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- in eax, dx
- test al, #0x01
- jnz init_io_base
- mov ecx, eax
- mov eax, #0xffffffff
- out dx, eax
- in eax, dx
- cmp eax, ecx
- je next_pci_base
- xor eax, #0xffffffff
- mov ecx, eax
- mov eax, [bp-4]
- out dx, eax
- add eax, ecx ;; calculate next free mem base
- add eax, #0x01000000
- and eax, #0xff000000
- mov [bp-4], eax
- jmp next_pci_base
-init_io_base:
- mov cx, ax
- mov ax, #0xffff
- out dx, ax
- in ax, dx
- cmp ax, cx
- je next_pci_base
- xor ax, #0xfffe
- mov cx, ax
- mov ax, [bp-6]
- out dx, ax
- add ax, cx ;; calculate next free i/o base
- add ax, #0x0100
- and ax, #0xff00
- mov [bp-6], ax
-next_pci_base:
- mov al, [bp-8]
- add al, #0x04
- cmp al, #0x28
- je enable_iomem_space
- mov byte ptr[bp-8], al
- jmp pci_init_io_loop2
-enable_iomem_space:
- mov dl, #0x04 ;; enable i/o and memory space access if available
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- in al, dx
- or al, #0x07
- out dx, al
-next_pci_dev:
- mov byte ptr[bp-8], #0x10
- inc bx
- cmp bx, #0x0100
- jne pci_init_io_loop1
- mov sp, bp
- pop bp
- ret
-
-pcibios_init_set_elcr:
- push ax
- push cx
- mov dx, #0x04d0
- test al, #0x08
- jz is_master_pic
- inc dx
- and al, #0x07
-is_master_pic:
- mov cl, al
- mov bl, #0x01
- shl bl, cl
- in al, dx
- or al, bl
- out dx, al
- pop cx
- pop ax
- ret
-
-pcibios_init_irqs:
- push ds
- push bp
- mov ax, #0xf000
- mov ds, ax
- mov dx, #0x04d0 ;; reset ELCR1 + ELCR2
- mov al, #0x00
- out dx, al
- inc dx
- out dx, al
- mov si, #pci_routing_table_structure
- mov bh, [si+8]
- mov bl, [si+9]
- mov dl, #0x00
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- in eax, dx
- cmp eax, [si+12] ;; check irq router
- jne pci_init_end
- mov dl, [si+34]
- call pcibios_init_sel_reg
- push bx ;; save irq router bus + devfunc
- mov dx, #0x0cfc
- mov ax, #0x8080
- out dx, ax ;; reset PIRQ route control
- inc dx
- inc dx
- out dx, ax
- mov ax, [si+6]
- sub ax, #0x20
- shr ax, #4
- mov cx, ax
- add si, #0x20 ;; set pointer to 1st entry
- mov bp, sp
- mov ax, #pci_irq_list
- push ax
- xor ax, ax
- push ax
-pci_init_irq_loop1:
- mov bh, [si]
- mov bl, [si+1]
-pci_init_irq_loop2:
- mov dl, #0x00
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- in ax, dx
- cmp ax, #0xffff
- jnz pci_test_int_pin
- test bl, #0x07
- jz next_pir_entry
- jmp next_pci_func
-pci_test_int_pin:
- mov dl, #0x3c
- call pcibios_init_sel_reg
- mov dx, #0x0cfd
- in al, dx
- and al, #0x07
- jz next_pci_func
- dec al ;; determine pirq reg
- mov dl, #0x03
- mul al, dl
- add al, #0x02
- xor ah, ah
- mov bx, ax
- mov al, [si+bx]
- mov dl, al
- mov bx, [bp]
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- and al, #0x03
- add dl, al
- in al, dx
- cmp al, #0x80
- jb pirq_found
- mov bx, [bp-2] ;; pci irq list pointer
- mov al, [bx]
- out dx, al
- inc bx
- mov [bp-2], bx
- call pcibios_init_set_elcr
-pirq_found:
- mov bh, [si]
- mov bl, [si+1]
- add bl, [bp-3] ;; pci function number
- mov dl, #0x3c
- call pcibios_init_sel_reg
- mov dx, #0x0cfc
- out dx, al
-next_pci_func:
- inc byte ptr[bp-3]
- inc bl
- test bl, #0x07
- jnz pci_init_irq_loop2
-next_pir_entry:
- add si, #0x10
- mov byte ptr[bp-3], #0x00
- loop pci_init_irq_loop1
- mov sp, bp
- pop bx
-pci_init_end:
- pop bp
- pop ds
- ret
-#endif // BX_PCIBIOS
-
-; parallel port detection: base address in DX, index in BX, timeout in CL
-detect_parport:
- push dx
- add dx, #2
- in al, dx
- and al, #0xdf ; clear input mode
- out dx, al
- pop dx
- mov al, #0xaa
- out dx, al
- in al, dx
- cmp al, #0xaa
- jne no_parport
- push bx
- shl bx, #1
- mov [bx+0x408], dx ; Parallel I/O address
- pop bx
- mov [bx+0x478], cl ; Parallel printer timeout
- inc bx
-no_parport:
- ret
-
-; serial port detection: base address in DX, index in BX, timeout in CL
-detect_serial:
- push dx
- inc dx
- mov al, #0x02
- out dx, al
- in al, dx
- cmp al, #0x02
- jne no_serial
- inc dx
- in al, dx
- cmp al, #0x02
- jne no_serial
- dec dx
- xor al, al
- out dx, al
- pop dx
- push bx
- shl bx, #1
- mov [bx+0x400], dx ; Serial I/O address
- pop bx
- mov [bx+0x47c], cl ; Serial timeout
- inc bx
- ret
-no_serial:
- pop dx
- ret
-
-rom_checksum:
- push ax
- push bx
- push cx
- xor ax, ax
- xor bx, bx
- xor cx, cx
- mov ch, [2]
- shl cx, #1
-checksum_loop:
- add al, [bx]
- inc bx
- loop checksum_loop
- and al, #0xff
- pop cx
- pop bx
- pop ax
- ret
-
-rom_scan:
- ;; Scan for existence of valid expansion ROMS.
- ;; Video ROM: from 0xC0000..0xC7FFF in 2k increments
- ;; General ROM: from 0xC8000..0xDFFFF in 2k increments
- ;; System ROM: only 0xE0000
- ;;
- ;; Header:
- ;; Offset Value
- ;; 0 0x55
- ;; 1 0xAA
- ;; 2 ROM length in 512-byte blocks
- ;; 3 ROM initialization entry point (FAR CALL)
-
- mov cx, #0xc000
-rom_scan_loop:
- mov ds, cx
- mov ax, #0x0004 ;; start with increment of 4 (512-byte) blocks = 2k
- cmp [0], #0xAA55 ;; look for signature
- jne rom_scan_increment
- call rom_checksum
- jnz rom_scan_increment
- mov al, [2] ;; change increment to ROM length in 512-byte blocks
-
- ;; We want our increment in 512-byte quantities, rounded to
- ;; the nearest 2k quantity, since we only scan at 2k intervals.
- test al, #0x03
- jz block_count_rounded
- and al, #0xfc ;; needs rounding up
- add al, #0x04
-block_count_rounded:
-
- xor bx, bx ;; Restore DS back to 0000:
- mov ds, bx
- push ax ;; Save AX
- ;; Push addr of ROM entry point
- push cx ;; Push seg
- push #0x0003 ;; Push offset
- mov bp, sp ;; Call ROM init routine using seg:off on stack
- db 0xff ;; call_far ss:[bp+0]
- db 0x5e
- db 0
- cli ;; In case expansion ROM BIOS turns IF on
- add sp, #2 ;; Pop offset value
- pop cx ;; Pop seg value (restore CX)
- pop ax ;; Restore AX
-rom_scan_increment:
- shl ax, #5 ;; convert 512-bytes blocks to 16-byte increments
- ;; because the segment selector is shifted left 4 bits.
- add cx, ax
- cmp cx, #0xe000
- jbe rom_scan_loop
-
- xor ax, ax ;; Restore DS back to 0000:
- mov ds, ax
- ret
-
-;; for 'C' strings and other data, insert them here with
-;; a the following hack:
-;; DATA_SEG_DEFS_HERE
-
-
-;--------
-;- POST -
-;--------
-.org 0xe05b ; POST Entry Point
-post:
-
- xor ax, ax
-
- ;; first reset the DMA controllers
- out 0x0d,al
- out 0xda,al
-
- ;; then initialize the DMA controllers
- mov al, #0xC0
- out 0xD6, al ; cascade mode of channel 4 enabled
- mov al, #0x00
- out 0xD4, al ; unmask channel 4
-
- ;; Examine CMOS shutdown status.
- mov AL, #0x0f
- out 0x70, AL
- in AL, 0x71
-
- ;; backup status
- mov bl, al
-
- ;; Reset CMOS shutdown status.
- mov AL, #0x0f
- out 0x70, AL ; select CMOS register Fh
- mov AL, #0x00
- out 0x71, AL ; set shutdown action to normal
-
- ;; Examine CMOS shutdown status.
- mov al, bl
-
- ;; 0x00, 0x09, 0x0D+ = normal startup
- cmp AL, #0x00
- jz normal_post
- cmp AL, #0x0d
- jae normal_post
- cmp AL, #0x09
- je normal_post
-
- ;; 0x05 = eoi + jmp via [0x40:0x67] jump
- cmp al, #0x05
- je eoi_jmp_post
-
- ;; Examine CMOS shutdown status.
- ;; 0x01,0x02,0x03,0x04,0x06,0x07,0x08, 0x0a, 0x0b, 0x0c = Unimplemented shutdown status.
- push bx
- call _shutdown_status_panic
-
-#if 0
- HALT(__LINE__)
- ;
- ;#if 0
- ; 0xb0, 0x20, /* mov al, #0x20 */
- ; 0xe6, 0x20, /* out 0x20, al ;send EOI to PIC */
- ;#endif
- ;
- pop es
- pop ds
- popa
- iret
-#endif
-
-normal_post:
- ; case 0: normal startup
-
- cli
- mov ax, #0xfffe
- mov sp, ax
- mov ax, #0x0000
- mov ds, ax
- mov ss, ax
-
- ;; zero out BIOS data area (40:00..40:ff)
- mov es, ax
- mov cx, #0x0080 ;; 128 words
- mov di, #0x0400
- cld
- rep
- stosw
-
- call _log_bios_start
-
- ;; set all interrupts to default handler
- mov bx, #0x0000 ;; offset index
- mov cx, #0x0100 ;; counter (256 interrupts)
- mov ax, #dummy_iret_handler
- mov dx, #0xF000
-
-post_default_ints:
- mov [bx], ax
- inc bx
- inc bx
- mov [bx], dx
- inc bx
- inc bx
- loop post_default_ints
-
- ;; set vector 0x79 to zero
- ;; this is used by 'gardian angel' protection system
- SET_INT_VECTOR(0x79, #0, #0)
-
- ;; base memory in K 40:13 (word)
- mov ax, #BASE_MEM_IN_K
- mov 0x0413, ax
-
-
- ;; Manufacturing Test 40:12
- ;; zerod out above
-
- ;; Warm Boot Flag 0040:0072
- ;; value of 1234h = skip memory checks
- ;; zerod out above
-
-
- ;; Printer Services vector
- SET_INT_VECTOR(0x17, #0xF000, #int17_handler)
-
- ;; Bootstrap failure vector
- SET_INT_VECTOR(0x18, #0xF000, #int18_handler)
-
- ;; Bootstrap Loader vector
- SET_INT_VECTOR(0x19, #0xF000, #int19_handler)
-
- ;; User Timer Tick vector
- SET_INT_VECTOR(0x1c, #0xF000, #int1c_handler)
-
- ;; Memory Size Check vector
- SET_INT_VECTOR(0x12, #0xF000, #int12_handler)
-
- ;; Equipment Configuration Check vector
- SET_INT_VECTOR(0x11, #0xF000, #int11_handler)
-
- ;; System Services
- SET_INT_VECTOR(0x15, #0xF000, #int15_handler)
-
- ;; EBDA setup
- call ebda_post
-
- ;; PIT setup
- SET_INT_VECTOR(0x08, #0xF000, #int08_handler)
- ;; int 1C already points at dummy_iret_handler (above)
- mov al, #0x34 ; timer0: binary count, 16bit count, mode 2
- out 0x43, al
- mov al, #0x00 ; maximum count of 0000H = 18.2Hz
- out 0x40, al
- out 0x40, al
-
- ;; Keyboard
- SET_INT_VECTOR(0x09, #0xF000, #int09_handler)
- SET_INT_VECTOR(0x16, #0xF000, #int16_handler)
-
- xor ax, ax
- mov ds, ax
- mov 0x0417, al /* keyboard shift flags, set 1 */
- mov 0x0418, al /* keyboard shift flags, set 2 */
- mov 0x0419, al /* keyboard alt-numpad work area */
- mov 0x0471, al /* keyboard ctrl-break flag */
- mov 0x0497, al /* keyboard status flags 4 */
- mov al, #0x10
- mov 0x0496, al /* keyboard status flags 3 */
-
-
- /* keyboard head of buffer pointer */
- mov bx, #0x001E
- mov 0x041A, bx
-
- /* keyboard end of buffer pointer */
- mov 0x041C, bx
-
- /* keyboard pointer to start of buffer */
- mov bx, #0x001E
- mov 0x0480, bx
-
- /* keyboard pointer to end of buffer */
- mov bx, #0x003E
- mov 0x0482, bx
-
- /* init the keyboard */
- call _keyboard_init
-
- ;; mov CMOS Equipment Byte to BDA Equipment Word
- mov ax, 0x0410
- mov al, #0x14
- out 0x70, al
- in al, 0x71
- mov 0x0410, ax
-
-
- ;; Parallel setup
- SET_INT_VECTOR(0x0F, #0xF000, #dummy_iret_handler)
- xor ax, ax
- mov ds, ax
- xor bx, bx
- mov cl, #0x14 ; timeout value
- mov dx, #0x378 ; Parallel I/O address, port 1
- call detect_parport
- mov dx, #0x278 ; Parallel I/O address, port 2
- call detect_parport
- shl bx, #0x0e
- mov ax, 0x410 ; Equipment word bits 14..15 determing # parallel ports
- and ax, #0x3fff
- or ax, bx ; set number of parallel ports
- mov 0x410, ax
-
- ;; Serial setup
- SET_INT_VECTOR(0x0C, #0xF000, #dummy_iret_handler)
- SET_INT_VECTOR(0x14, #0xF000, #int14_handler)
- xor bx, bx
- mov cl, #0x0a ; timeout value
- mov dx, #0x03f8 ; Serial I/O address, port 1
- call detect_serial
- mov dx, #0x02f8 ; Serial I/O address, port 2
- call detect_serial
- mov dx, #0x03e8 ; Serial I/O address, port 3
- call detect_serial
- mov dx, #0x02e8 ; Serial I/O address, port 4
- call detect_serial
- shl bx, #0x09
- mov ax, 0x410 ; Equipment word bits 9..11 determing # serial ports
- and ax, #0xf1ff
- or ax, bx ; set number of serial port
- mov 0x410, ax
-
- ;; CMOS RTC
- SET_INT_VECTOR(0x1A, #0xF000, #int1a_handler)
- SET_INT_VECTOR(0x4A, #0xF000, #dummy_iret_handler)
- SET_INT_VECTOR(0x70, #0xF000, #int70_handler)
- ;; BIOS DATA AREA 0x4CE ???
- call timer_tick_post
-
- ;; PS/2 mouse setup
- SET_INT_VECTOR(0x74, #0xF000, #int74_handler)
-
- ;; IRQ13 (FPU exception) setup
- SET_INT_VECTOR(0x75, #0xF000, #int75_handler)
-
- ;; Video setup
- SET_INT_VECTOR(0x10, #0xF000, #int10_handler)
-
- ;; PIC
- mov al, #0x11 ; send initialisation commands
- out 0x20, al
- out 0xa0, al
- mov al, #0x08
- out 0x21, al
- mov al, #0x70
- out 0xa1, al
- mov al, #0x04
- out 0x21, al
- mov al, #0x02
- out 0xa1, al
- mov al, #0x01
- out 0x21, al
- out 0xa1, al
- mov al, #0xb8
- out 0x21, AL ;master pic: unmask IRQ 0, 1, 2, 6
-#if BX_USE_PS2_MOUSE
- mov al, #0x8f
-#else
- mov al, #0x9f
-#endif
- out 0xa1, AL ;slave pic: unmask IRQ 12, 13, 14
-
-#if BX_PCIBIOS
- call pcibios_init_iomem_bases
- call pcibios_init_irqs
-#endif
-
- call rom_scan
-
- call _print_bios_banner
-
- ;;
- ;; Floppy setup
- ;;
- call floppy_drive_post
-
-#if BX_USE_ATADRV
-
- ;;
- ;; Hard Drive setup
- ;;
- call hard_drive_post
-
- ;;
- ;; ATA/ATAPI driver setup
- ;;
- call _ata_init
- call _ata_detect
- ;;
-#else // BX_USE_ATADRV
-
- ;;
- ;; Hard Drive setup
- ;;
- call hard_drive_post
-
-#endif // BX_USE_ATADRV
-
-#if BX_ELTORITO_BOOT
- ;;
- ;; eltorito floppy/harddisk emulation from cd
- ;;
- call _cdemu_init
- ;;
-#endif // BX_ELTORITO_BOOT
-
- sti ;; enable interrupts
- int #0x19
-
-
-.org 0xe2c3 ; NMI Handler Entry Point
-nmi:
- ;; FIXME the NMI handler should not panic
- ;; but iret when called from int75 (fpu exception)
- call _nmi_handler_msg
- iret
-
-int75_handler:
- out 0xf0, al // clear irq13
- call eoi_both_pics // clear interrupt
- int 2 // legacy nmi call
- iret
-
-;-------------------------------------------
-;- INT 13h Fixed Disk Services Entry Point -
-;-------------------------------------------
-.org 0xe3fe ; INT 13h Fixed Disk Services Entry Point
-int13_handler:
- //JMPL(int13_relocated)
- jmp int13_relocated
-
-.org 0xe401 ; Fixed Disk Parameter Table
-
-;----------
-;- INT19h -
-;----------
-.org 0xe6f2 ; INT 19h Boot Load Service Entry Point
-int19_handler:
-
- jmp int19_relocated
-;-------------------------------------------
-;- System BIOS Configuration Data Table
-;-------------------------------------------
-.org BIOS_CONFIG_TABLE
-db 0x08 ; Table size (bytes) -Lo
-db 0x00 ; Table size (bytes) -Hi
-db SYS_MODEL_ID
-db SYS_SUBMODEL_ID
-db BIOS_REVISION
-; Feature byte 1
-; b7: 1=DMA channel 3 used by hard disk
-; b6: 1=2 interrupt controllers present
-; b5: 1=RTC present
-; b4: 1=BIOS calls int 15h/4Fh every key
-; b3: 1=wait for extern event supported (Int 15h/41h)
-; b2: 1=extended BIOS data area used
-; b1: 0=AT or ESDI bus, 1=MicroChannel
-; b0: 1=Dual bus (MicroChannel + ISA)
-db (0 << 7) | \
- (1 << 6) | \
- (1 << 5) | \
- (BX_CALL_INT15_4F << 4) | \
- (0 << 3) | \
- (BX_USE_EBDA << 2) | \
- (0 << 1) | \
- (0 << 0)
-; Feature byte 2
-; b7: 1=32-bit DMA supported
-; b6: 1=int16h, function 9 supported
-; b5: 1=int15h/C6h (get POS data) supported
-; b4: 1=int15h/C7h (get mem map info) supported
-; b3: 1=int15h/C8h (en/dis CPU) supported
-; b2: 1=non-8042 kb controller
-; b1: 1=data streaming supported
-; b0: reserved
-db (0 << 7) | \
- (1 << 6) | \
- (0 << 5) | \
- (0 << 4) | \
- (0 << 3) | \
- (0 << 2) | \
- (0 << 1) | \
- (0 << 0)
-; Feature byte 3
-; b7: not used
-; b6: reserved
-; b5: reserved
-; b4: POST supports ROM-to-RAM enable/disable
-; b3: SCSI on system board
-; b2: info panel installed
-; b1: Initial Machine Load (IML) system - BIOS on disk
-; b0: SCSI supported in IML
-db 0x00
-; Feature byte 4
-; b7: IBM private
-; b6: EEPROM present
-; b5-3: ABIOS presence (011 = not supported)
-; b2: private
-; b1: memory split above 16Mb supported
-; b0: POSTEXT directly supported by POST
-db 0x00
-; Feature byte 5 (IBM)
-; b1: enhanced mouse
-; b0: flash EPROM
-db 0x00
-
-
-
-.org 0xe729 ; Baud Rate Generator Table
-
-;----------
-;- INT14h -
-;----------
-.org 0xe739 ; INT 14h Serial Communications Service Entry Point
-int14_handler:
- push ds
- pusha
- mov ax, #0x0000
- mov ds, ax
- call _int14_function
- popa
- pop ds
- iret
-
-
-;----------------------------------------
-;- INT 16h Keyboard Service Entry Point -
-;----------------------------------------
-.org 0xe82e
-int16_handler:
-
- sti
- push ds
- pushf
- pusha
-
- cmp ah, #0x00
- je int16_F00
- cmp ah, #0x10
- je int16_F00
-
- mov bx, #0xf000
- mov ds, bx
- call _int16_function
- popa
- popf
- pop ds
- jz int16_zero_set
-
-int16_zero_clear:
- push bp
- mov bp, sp
- //SEG SS
- and BYTE [bp + 0x06], #0xbf
- pop bp
- iret
-
-int16_zero_set:
- push bp
- mov bp, sp
- //SEG SS
- or BYTE [bp + 0x06], #0x40
- pop bp
- iret
-
-int16_F00:
- mov bx, #0x0040
- mov ds, bx
-
-int16_wait_for_key:
- cli
- mov bx, 0x001a
- cmp bx, 0x001c
- jne int16_key_found
- sti
- nop
-#if 0
- /* no key yet, call int 15h, function AX=9002 */
- 0x50, /* push AX */
- 0xb8, 0x02, 0x90, /* mov AX, #0x9002 */
- 0xcd, 0x15, /* int 15h */
- 0x58, /* pop AX */
- 0xeb, 0xea, /* jmp WAIT_FOR_KEY */
-#endif
- jmp int16_wait_for_key
-
-int16_key_found:
- mov bx, #0xf000
- mov ds, bx
- call _int16_function
- popa
- popf
- pop ds
-#if 0
- /* notify int16 complete w/ int 15h, function AX=9102 */
- 0x50, /* push AX */
- 0xb8, 0x02, 0x91, /* mov AX, #0x9102 */
- 0xcd, 0x15, /* int 15h */
- 0x58, /* pop AX */
-#endif
- iret
-
-
-
-;-------------------------------------------------
-;- INT09h : Keyboard Hardware Service Entry Point -
-;-------------------------------------------------
-.org 0xe987
-int09_handler:
- cli
- push ax
-
- mov al, #0xAD ;;disable keyboard
- out #0x64, al
-
- mov al, #0x0B
- out #0x20, al
- in al, #0x20
- and al, #0x02
- jz int09_finish
-
- in al, #0x60 ;;read key from keyboard controller
- sti
- push ds
- pusha
-#ifdef BX_CALL_INT15_4F
- mov ah, #0x4f ;; allow for keyboard intercept
- stc
- int #0x15
- jnc int09_done
-#endif
-
- ;; check for extended key
- cmp al, #0xe0
- jne int09_check_pause
- xor ax, ax
- mov ds, ax
- mov al, BYTE [0x496] ;; mf2_state |= 0x02
- or al, #0x02
- mov BYTE [0x496], al
- jmp int09_done
-
-int09_check_pause: ;; check for pause key
- cmp al, #0xe1
- jne int09_process_key
- xor ax, ax
- mov ds, ax
- mov al, BYTE [0x496] ;; mf2_state |= 0x01
- or al, #0x01
- mov BYTE [0x496], al
- jmp int09_done
-
-int09_process_key:
- mov bx, #0xf000
- mov ds, bx
- call _int09_function
-
-int09_done:
- popa
- pop ds
- cli
- call eoi_master_pic
-
-int09_finish:
- mov al, #0xAE ;;enable keyboard
- out #0x64, al
- pop ax
- iret
-
-
-;----------------------------------------
-;- INT 13h Diskette Service Entry Point -
-;----------------------------------------
-.org 0xec59
-int13_diskette:
- jmp int13_noeltorito
-
-;---------------------------------------------
-;- INT 0Eh Diskette Hardware ISR Entry Point -
-;---------------------------------------------
-.org 0xef57 ; INT 0Eh Diskette Hardware ISR Entry Point
-int0e_handler:
- push ax
- push dx
- mov dx, #0x03f4
- in al, dx
- and al, #0xc0
- cmp al, #0xc0
- je int0e_normal
- mov dx, #0x03f5
- mov al, #0x08 ; sense interrupt status
- out dx, al
-int0e_loop1:
- mov dx, #0x03f4
- in al, dx
- and al, #0xc0
- cmp al, #0xc0
- jne int0e_loop1
-int0e_loop2:
- mov dx, #0x03f5
- in al, dx
- mov dx, #0x03f4
- in al, dx
- and al, #0xc0
- cmp al, #0xc0
- je int0e_loop2
-int0e_normal:
- push ds
- mov ax, #0x0000 ;; segment 0000
- mov ds, ax
- call eoi_master_pic
- mov al, 0x043e
- or al, #0x80 ;; diskette interrupt has occurred
- mov 0x043e, al
- pop ds
- pop dx
- pop ax
- iret
-
-
-.org 0xefc7 ; Diskette Controller Parameter Table
-diskette_param_table:
-;; Since no provisions are made for multiple drive types, most
-;; values in this table are ignored. I set parameters for 1.44M
-;; floppy here
-db 0xAF
-db 0x02 ;; head load time 0000001, DMA used
-db 0x25
-db 0x02
-db 18
-db 0x1B
-db 0xFF
-db 0x6C
-db 0xF6
-db 0x0F
-db 0x08
-
-
-;----------------------------------------
-;- INT17h : Printer Service Entry Point -
-;----------------------------------------
-.org 0xefd2
-int17_handler:
- push ds
- pusha
- mov ax, #0x0000
- mov ds, ax
- call _int17_function
- popa
- pop ds
- iret
-
-diskette_param_table2:
-;; New diskette parameter table adding 3 parameters from IBM
-;; Since no provisions are made for multiple drive types, most
-;; values in this table are ignored. I set parameters for 1.44M
-;; floppy here
-db 0xAF
-db 0x02 ;; head load time 0000001, DMA used
-db 0x25
-db 0x02
-db 18
-db 0x1B
-db 0xFF
-db 0x6C
-db 0xF6
-db 0x0F
-db 0x08
-db 79 ;; maximum track
-db 0 ;; data transfer rate
-db 4 ;; drive type in cmos
-
-.org 0xf045 ; INT 10 Functions 0-Fh Entry Point
- HALT(__LINE__)
- iret
-
-;----------
-;- INT10h -
-;----------
-.org 0xf065 ; INT 10h Video Support Service Entry Point
-int10_handler:
- ;; dont do anything, since the VGA BIOS handles int10h requests
- iret
-
-.org 0xf0a4 ; MDA/CGA Video Parameter Table (INT 1Dh)
-
-;----------
-;- INT12h -
-;----------
-.org 0xf841 ; INT 12h Memory Size Service Entry Point
-; ??? different for Pentium (machine check)?
-int12_handler:
- push ds
- mov ax, #0x0040
- mov ds, ax
- mov ax, 0x0013
- pop ds
- iret
-
-;----------
-;- INT11h -
-;----------
-.org 0xf84d ; INT 11h Equipment List Service Entry Point
-int11_handler:
- push ds
- mov ax, #0x0040
- mov ds, ax
- mov ax, 0x0010
- pop ds
- iret
-
-;----------
-;- INT15h -
-;----------
-.org 0xf859 ; INT 15h System Services Entry Point
-int15_handler:
- pushf
- push ds
- push es
- cmp ah, #0x86
- je int15_handler32
- cmp ah, #0xE8
- je int15_handler32
- pusha
-#if BX_USE_PS2_MOUSE
- cmp ah, #0xC2
- je int15_handler_mouse
-#endif
- call _int15_function
-int15_handler_mouse_ret:
- popa
-int15_handler32_ret:
- pop es
- pop ds
- popf
- jmp iret_modify_cf
-
-#if BX_USE_PS2_MOUSE
-int15_handler_mouse:
- call _int15_function_mouse
- jmp int15_handler_mouse_ret
-#endif
-
-int15_handler32:
- pushad
- call _int15_function32
- popad
- jmp int15_handler32_ret
-
-;; Protected mode IDT descriptor
-;;
-;; I just make the limit 0, so the machine will shutdown
-;; if an exception occurs during protected mode memory
-;; transfers.
-;;
-;; Set base to f0000 to correspond to beginning of BIOS,
-;; in case I actually define an IDT later
-;; Set limit to 0
-
-pmode_IDT_info:
-dw 0x0000 ;; limit 15:00
-dw 0x0000 ;; base 15:00
-db 0x0f ;; base 23:16
-
-;; Real mode IDT descriptor
-;;
-;; Set to typical real-mode values.
-;; base = 000000
-;; limit = 03ff
-
-rmode_IDT_info:
-dw 0x03ff ;; limit 15:00
-dw 0x0000 ;; base 15:00
-db 0x00 ;; base 23:16
-
-
-;----------
-;- INT1Ah -
-;----------
-.org 0xfe6e ; INT 1Ah Time-of-day Service Entry Point
-int1a_handler:
-#if BX_PCIBIOS
- cmp ah, #0xb1
- jne int1a_normal
- call pcibios_real
- jc pcibios_error
- retf 2
-pcibios_error:
- mov bl, ah
- mov ah, #0xb1
- push ds
- pusha
- mov ax, ss ; set readable descriptor to ds, for calling pcibios
- mov ds, ax ; on 16bit protected mode.
- jmp int1a_callfunction
-int1a_normal:
-#endif
- push ds
- pusha
- xor ax, ax
- mov ds, ax
-int1a_callfunction:
- call _int1a_function
- popa
- pop ds
- iret
-
-;;
-;; int70h: IRQ8 - CMOS RTC
-;;
-int70_handler:
- push ds
- pushad
- xor ax, ax
- mov ds, ax
- call _int70_function
- popad
- pop ds
- iret
-
-;---------
-;- INT08 -
-;---------
-.org 0xfea5 ; INT 08h System Timer ISR Entry Point
-int08_handler:
- sti
- push eax
- push ds
- xor ax, ax
- mov ds, ax
-
- ;; time to turn off drive(s)?
- mov al,0x0440
- or al,al
- jz int08_floppy_off
- dec al
- mov 0x0440,al
- jnz int08_floppy_off
- ;; turn motor(s) off
- push dx
- mov dx,#0x03f2
- in al,dx
- and al,#0xcf
- out dx,al
- pop dx
-int08_floppy_off:
-
- mov eax, 0x046c ;; get ticks dword
- inc eax
-
- ;; compare eax to one days worth of timer ticks at 18.2 hz
- cmp eax, #0x001800B0
- jb int08_store_ticks
- ;; there has been a midnight rollover at this point
- xor eax, eax ;; zero out counter
- inc BYTE 0x0470 ;; increment rollover flag
-
-int08_store_ticks:
- mov 0x046c, eax ;; store new ticks dword
- ;; chain to user timer tick INT #0x1c
- //pushf
- //;; call_ep [ds:loc]
- //CALL_EP( 0x1c << 2 )
- int #0x1c
- cli
- call eoi_master_pic
- pop ds
- pop eax
- iret
-
-.org 0xfef3 ; Initial Interrupt Vector Offsets Loaded by POST
-
-
-.org 0xff00
-.ascii BIOS_COPYRIGHT_STRING
-
-;------------------------------------------------
-;- IRET Instruction for Dummy Interrupt Handler -
-;------------------------------------------------
-.org 0xff53 ; IRET Instruction for Dummy Interrupt Handler
-dummy_iret_handler:
- iret
-
-.org 0xff54 ; INT 05h Print Screen Service Entry Point
- HALT(__LINE__)
- iret
-
-.org 0xfff0 ; Power-up Entry Point
- jmp 0xf000:post
-
-.org 0xfff5 ; ASCII Date ROM was built - 8 characters in MM/DD/YY
-.ascii BIOS_BUILD_DATE
-
-.org 0xfffe ; System Model ID
-db SYS_MODEL_ID
-db 0x00 ; filler
-
-.org 0xfa6e ;; Character Font for 320x200 & 640x200 Graphics (lower 128 characters)
-ASM_END
-/*
- * This font comes from the fntcol16.zip package (c) by Joseph Gil
- * found at ftp://ftp.simtel.net/pub/simtelnet/msdos/screen/fntcol16.zip
- * This font is public domain
- */
-static Bit8u vgafont8[128*8]=
-{
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x7e, 0x81, 0xa5, 0x81, 0xbd, 0x99, 0x81, 0x7e,
- 0x7e, 0xff, 0xdb, 0xff, 0xc3, 0xe7, 0xff, 0x7e,
- 0x6c, 0xfe, 0xfe, 0xfe, 0x7c, 0x38, 0x10, 0x00,
- 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x10, 0x00,
- 0x38, 0x7c, 0x38, 0xfe, 0xfe, 0x7c, 0x38, 0x7c,
- 0x10, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x7c,
- 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x18, 0x00, 0x00,
- 0xff, 0xff, 0xe7, 0xc3, 0xc3, 0xe7, 0xff, 0xff,
- 0x00, 0x3c, 0x66, 0x42, 0x42, 0x66, 0x3c, 0x00,
- 0xff, 0xc3, 0x99, 0xbd, 0xbd, 0x99, 0xc3, 0xff,
- 0x0f, 0x07, 0x0f, 0x7d, 0xcc, 0xcc, 0xcc, 0x78,
- 0x3c, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x18,
- 0x3f, 0x33, 0x3f, 0x30, 0x30, 0x70, 0xf0, 0xe0,
- 0x7f, 0x63, 0x7f, 0x63, 0x63, 0x67, 0xe6, 0xc0,
- 0x99, 0x5a, 0x3c, 0xe7, 0xe7, 0x3c, 0x5a, 0x99,
- 0x80, 0xe0, 0xf8, 0xfe, 0xf8, 0xe0, 0x80, 0x00,
- 0x02, 0x0e, 0x3e, 0xfe, 0x3e, 0x0e, 0x02, 0x00,
- 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x7e, 0x3c, 0x18,
- 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x66, 0x00,
- 0x7f, 0xdb, 0xdb, 0x7b, 0x1b, 0x1b, 0x1b, 0x00,
- 0x3e, 0x63, 0x38, 0x6c, 0x6c, 0x38, 0xcc, 0x78,
- 0x00, 0x00, 0x00, 0x00, 0x7e, 0x7e, 0x7e, 0x00,
- 0x18, 0x3c, 0x7e, 0x18, 0x7e, 0x3c, 0x18, 0xff,
- 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x18, 0x00,
- 0x18, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00,
- 0x00, 0x18, 0x0c, 0xfe, 0x0c, 0x18, 0x00, 0x00,
- 0x00, 0x30, 0x60, 0xfe, 0x60, 0x30, 0x00, 0x00,
- 0x00, 0x00, 0xc0, 0xc0, 0xc0, 0xfe, 0x00, 0x00,
- 0x00, 0x24, 0x66, 0xff, 0x66, 0x24, 0x00, 0x00,
- 0x00, 0x18, 0x3c, 0x7e, 0xff, 0xff, 0x00, 0x00,
- 0x00, 0xff, 0xff, 0x7e, 0x3c, 0x18, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x30, 0x78, 0x78, 0x30, 0x30, 0x00, 0x30, 0x00,
- 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x6c, 0x6c, 0xfe, 0x6c, 0xfe, 0x6c, 0x6c, 0x00,
- 0x30, 0x7c, 0xc0, 0x78, 0x0c, 0xf8, 0x30, 0x00,
- 0x00, 0xc6, 0xcc, 0x18, 0x30, 0x66, 0xc6, 0x00,
- 0x38, 0x6c, 0x38, 0x76, 0xdc, 0xcc, 0x76, 0x00,
- 0x60, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x18, 0x30, 0x60, 0x60, 0x60, 0x30, 0x18, 0x00,
- 0x60, 0x30, 0x18, 0x18, 0x18, 0x30, 0x60, 0x00,
- 0x00, 0x66, 0x3c, 0xff, 0x3c, 0x66, 0x00, 0x00,
- 0x00, 0x30, 0x30, 0xfc, 0x30, 0x30, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x60,
- 0x00, 0x00, 0x00, 0xfc, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x00,
- 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc0, 0x80, 0x00,
- 0x7c, 0xc6, 0xce, 0xde, 0xf6, 0xe6, 0x7c, 0x00,
- 0x30, 0x70, 0x30, 0x30, 0x30, 0x30, 0xfc, 0x00,
- 0x78, 0xcc, 0x0c, 0x38, 0x60, 0xcc, 0xfc, 0x00,
- 0x78, 0xcc, 0x0c, 0x38, 0x0c, 0xcc, 0x78, 0x00,
- 0x1c, 0x3c, 0x6c, 0xcc, 0xfe, 0x0c, 0x1e, 0x00,
- 0xfc, 0xc0, 0xf8, 0x0c, 0x0c, 0xcc, 0x78, 0x00,
- 0x38, 0x60, 0xc0, 0xf8, 0xcc, 0xcc, 0x78, 0x00,
- 0xfc, 0xcc, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x00,
- 0x78, 0xcc, 0xcc, 0x78, 0xcc, 0xcc, 0x78, 0x00,
- 0x78, 0xcc, 0xcc, 0x7c, 0x0c, 0x18, 0x70, 0x00,
- 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x00,
- 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x60,
- 0x18, 0x30, 0x60, 0xc0, 0x60, 0x30, 0x18, 0x00,
- 0x00, 0x00, 0xfc, 0x00, 0x00, 0xfc, 0x00, 0x00,
- 0x60, 0x30, 0x18, 0x0c, 0x18, 0x30, 0x60, 0x00,
- 0x78, 0xcc, 0x0c, 0x18, 0x30, 0x00, 0x30, 0x00,
- 0x7c, 0xc6, 0xde, 0xde, 0xde, 0xc0, 0x78, 0x00,
- 0x30, 0x78, 0xcc, 0xcc, 0xfc, 0xcc, 0xcc, 0x00,
- 0xfc, 0x66, 0x66, 0x7c, 0x66, 0x66, 0xfc, 0x00,
- 0x3c, 0x66, 0xc0, 0xc0, 0xc0, 0x66, 0x3c, 0x00,
- 0xf8, 0x6c, 0x66, 0x66, 0x66, 0x6c, 0xf8, 0x00,
- 0xfe, 0x62, 0x68, 0x78, 0x68, 0x62, 0xfe, 0x00,
- 0xfe, 0x62, 0x68, 0x78, 0x68, 0x60, 0xf0, 0x00,
- 0x3c, 0x66, 0xc0, 0xc0, 0xce, 0x66, 0x3e, 0x00,
- 0xcc, 0xcc, 0xcc, 0xfc, 0xcc, 0xcc, 0xcc, 0x00,
- 0x78, 0x30, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00,
- 0x1e, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78, 0x00,
- 0xe6, 0x66, 0x6c, 0x78, 0x6c, 0x66, 0xe6, 0x00,
- 0xf0, 0x60, 0x60, 0x60, 0x62, 0x66, 0xfe, 0x00,
- 0xc6, 0xee, 0xfe, 0xfe, 0xd6, 0xc6, 0xc6, 0x00,
- 0xc6, 0xe6, 0xf6, 0xde, 0xce, 0xc6, 0xc6, 0x00,
- 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0x6c, 0x38, 0x00,
- 0xfc, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xf0, 0x00,
- 0x78, 0xcc, 0xcc, 0xcc, 0xdc, 0x78, 0x1c, 0x00,
- 0xfc, 0x66, 0x66, 0x7c, 0x6c, 0x66, 0xe6, 0x00,
- 0x78, 0xcc, 0xe0, 0x70, 0x1c, 0xcc, 0x78, 0x00,
- 0xfc, 0xb4, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00,
- 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xfc, 0x00,
- 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x00,
- 0xc6, 0xc6, 0xc6, 0xd6, 0xfe, 0xee, 0xc6, 0x00,
- 0xc6, 0xc6, 0x6c, 0x38, 0x38, 0x6c, 0xc6, 0x00,
- 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x30, 0x78, 0x00,
- 0xfe, 0xc6, 0x8c, 0x18, 0x32, 0x66, 0xfe, 0x00,
- 0x78, 0x60, 0x60, 0x60, 0x60, 0x60, 0x78, 0x00,
- 0xc0, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x02, 0x00,
- 0x78, 0x18, 0x18, 0x18, 0x18, 0x18, 0x78, 0x00,
- 0x10, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff,
- 0x30, 0x30, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0x76, 0x00,
- 0xe0, 0x60, 0x60, 0x7c, 0x66, 0x66, 0xdc, 0x00,
- 0x00, 0x00, 0x78, 0xcc, 0xc0, 0xcc, 0x78, 0x00,
- 0x1c, 0x0c, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00,
- 0x00, 0x00, 0x78, 0xcc, 0xfc, 0xc0, 0x78, 0x00,
- 0x38, 0x6c, 0x60, 0xf0, 0x60, 0x60, 0xf0, 0x00,
- 0x00, 0x00, 0x76, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8,
- 0xe0, 0x60, 0x6c, 0x76, 0x66, 0x66, 0xe6, 0x00,
- 0x30, 0x00, 0x70, 0x30, 0x30, 0x30, 0x78, 0x00,
- 0x0c, 0x00, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78,
- 0xe0, 0x60, 0x66, 0x6c, 0x78, 0x6c, 0xe6, 0x00,
- 0x70, 0x30, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00,
- 0x00, 0x00, 0xcc, 0xfe, 0xfe, 0xd6, 0xc6, 0x00,
- 0x00, 0x00, 0xf8, 0xcc, 0xcc, 0xcc, 0xcc, 0x00,
- 0x00, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0x78, 0x00,
- 0x00, 0x00, 0xdc, 0x66, 0x66, 0x7c, 0x60, 0xf0,
- 0x00, 0x00, 0x76, 0xcc, 0xcc, 0x7c, 0x0c, 0x1e,
- 0x00, 0x00, 0xdc, 0x76, 0x66, 0x60, 0xf0, 0x00,
- 0x00, 0x00, 0x7c, 0xc0, 0x78, 0x0c, 0xf8, 0x00,
- 0x10, 0x30, 0x7c, 0x30, 0x30, 0x34, 0x18, 0x00,
- 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00,
- 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x00,
- 0x00, 0x00, 0xc6, 0xd6, 0xfe, 0xfe, 0x6c, 0x00,
- 0x00, 0x00, 0xc6, 0x6c, 0x38, 0x6c, 0xc6, 0x00,
- 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8,
- 0x00, 0x00, 0xfc, 0x98, 0x30, 0x64, 0xfc, 0x00,
- 0x1c, 0x30, 0x30, 0xe0, 0x30, 0x30, 0x1c, 0x00,
- 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x00,
- 0xe0, 0x30, 0x30, 0x1c, 0x30, 0x30, 0xe0, 0x00,
- 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0x00,
-};
-
-ASM_START
-.org 0xcc00
-// bcc-generated data will be placed here
-ASM_END
generated by cgit v1.2.3 (git 2.25.1) at 2024-12-12 01:49:54 +0000