floppy.c revision 2b114c590cf5a19f8047cd7bde9c7e5ae00aa22b
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync/*
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Copyright (C) 2006-2012 Oracle Corporation
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * This file is part of VirtualBox Open Source Edition (OSE), as
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * available from http://www.virtualbox.org. This file is free software;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * you can redistribute it and/or modify it under the terms of the GNU
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * General Public License (GPL) as published by the Free Software
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Foundation, in version 2 as it comes in the "COPYING" file of the
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * VirtualBox OSE distribution. VirtualBox OSE is distributed in the
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * --------------------------------------------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * This code is based on:
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * ROM BIOS for use with Bochs/Plex86/QEMU emulation environment
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Copyright (C) 2002 MandrakeSoft S.A.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * MandrakeSoft S.A.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * 43, rue d'Aboukir
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * 75002 Paris - France
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * http://www.linux-mandrake.com/
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * http://www.mandrakesoft.com/
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * This library is free software; you can redistribute it and/or
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * modify it under the terms of the GNU Lesser General Public
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * License as published by the Free Software Foundation; either
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * version 2 of the License, or (at your option) any later version.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * This library is distributed in the hope that it will be useful,
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * but WITHOUT ANY WARRANTY; without even the implied warranty of
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Lesser General Public License for more details.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * You should have received a copy of the GNU Lesser General Public
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * License along with this library; if not, write to the Free Software
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#include <stdint.h>
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#include "inlines.h"
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#include "biosint.h"
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncextern uint16_t get_floppy_dpt(uint8_t drive_type);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync//////////////////////
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync// FLOPPY functions //
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync//////////////////////
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncvoid set_diskette_ret_status(uint8_t value)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x0041, value);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncvoid set_diskette_current_cyl(uint8_t drive, uint8_t cyl)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive > 1)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_PANIC("set_diskette_current_cyl: drive > 1\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x0094+drive, cyl);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#if 1 //BX_SUPPORT_FLOPPY
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#if DEBUG_INT13_FL
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync# define BX_DEBUG_INT13_FL(...) BX_DEBUG(__VA_ARGS__)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync# define BX_DEBUG_INT13_FL(...)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define BX_FLOPPY_ON_CNT 37 /* 2 seconds */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncextern int diskette_param_table; /* At a fixed location. */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifndef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync/**
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Wait for the 7th bit of 0040:003e to be set by int0e_handler.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * @returns first 7 bits of byte 0040:003e, interrupts disabled.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncuint8_t floppy_wait_for_interrupt(void)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync for (;;)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 & 0x80)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return val8 & ~0x7f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable_hlt_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync/**
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * Wait for the 7th bit of 0040:003e to be set by int0e_handler or 0040:0040 to
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * be cleared by the timer, clearing the interrupt flag on success.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync *
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * @returns 0 on timeout with interrupts enabled.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * All 8 bits at 0040:003e on interrupt with interrupts disabled (i.e.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync * non-zero), after first clearing the 7th bit at 0040:003e.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncuint8_t floppy_wait_for_interrupt_or_timeout(void)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync for (;;)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8 = read_byte(0x0040, 0x0040);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 & 0x80) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, val8 & 0x7f);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return val8;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable_hlt_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif /* !VBOX_WITH_FLOPPY_IRQ_POLLING */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncvoid floppy_reset_controller(void)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Reset controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = inb(0x03f2);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f2, val8 & ~0x04);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f2, val8 | 0x04);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Wait for controller to come out of reset
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = inb(0x3f4);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( (val8 & 0xc0) != 0x80 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncvoid floppy_prepare_controller(uint16_t drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8, dor, prev_reset;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set 40:3e bit 7 to 0
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 &= 0x7f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn on motor of selected drive, DMA & int enabled, normal operation
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync prev_reset = inb(0x03f2) & 0x04;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync dor = 0x20;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync dor = 0x10;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync dor |= 0x0c;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync dor |= drive;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f2, dor);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // reset the disk motor timeout value of INT 08
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040,0x0040, BX_FLOPPY_ON_CNT);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // program data rate
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x008b);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 >>= 6;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f7, val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // wait for drive readiness
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = inb(0x3f4);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( (val8 & 0xc0) != 0x80 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (prev_reset == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn on interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // wait on 40:3e bit 7 to become 1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( (val8 & 0x80) == 0 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 &= 0x7f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = floppy_wait_for_interrupt(); /* (7th bit cleared in ret val) */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncbx_bool floppy_media_known(uint16_t drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint16_t media_state_offset;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e); // diskette recal status
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 >>= 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 &= 0x01;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state_offset = 0x0090;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state_offset += 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, media_state_offset);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = (val8 >> 4) & 0x01;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // checks passed, return KNOWN
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncbx_bool floppy_read_id(uint16_t drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t return_status[7];
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int i;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_prepare_controller(drive);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // send Read ID command (2 bytes) to controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0x4a); // 4a: Read ID (MFM)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, drive); // 0=drive0, 1=drive1, head always 0
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn on interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // wait on 40:3e bit 7 to become 1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = (read_byte(0x0040, 0x003e) & 0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( val8 == 0 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = 0; // separate asm from while() loop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn off interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_wait_for_interrupt();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // read 7 return status bytes from controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync for (i = 0; i < 7; ++i) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return_status[i] = inb(0x3f5);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( (return_status[0] & 0xc0) != 0 )
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncbx_bool floppy_drive_recal(uint16_t drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t val8;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint16_t curr_cyl_offset;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_prepare_controller(drive);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // send Recalibrate command (2 bytes) to controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0x07); // 07: Recalibrate
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, drive); // 0=drive0, 1=drive1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn on interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // wait on 40:3e bit 7 to become 1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = (read_byte(0x0040, 0x003e) & 0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( val8 == 0 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = 0; // separate asm from while() loop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn off interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set 40:3e bit 7 to 0, and calibrated bit
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 &= 0x7f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = floppy_wait_for_interrupt(); /* (7th bit cleared in ret val) */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set 40:3e bit 7 to 0, and calibrated bit
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 |= 0x02; // Drive 1 calibrated
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync curr_cyl_offset = 0x0095;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } else {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 |= 0x01; // Drive 0 calibrated
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync curr_cyl_offset = 0x0094;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, curr_cyl_offset, 0); // current cylinder is 0
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncbx_bool floppy_media_sense(uint16_t drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync bx_bool retval;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint16_t media_state_offset;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t drive_type, config_data, media_state;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (floppy_drive_recal(drive) == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Try the diskette data rates in the following order:
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 1 Mbps -> 500 Kbps -> 300 Kbps -> 250 Kbps
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // The 1 Mbps rate is only tried for 2.88M drives.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // ** config_data **
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Bitfields for diskette media control:
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Bit(s) Description (Table M0028)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 7-6 last data rate set by controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 00=500kbps, 01=300kbps, 10=250kbps, 11=1Mbps
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 5-4 last diskette drive step rate selected
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 00=0Ch, 01=0Dh, 10=0Eh, 11=0Ah
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 3-2 {data rate at start of operation}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 1-0 reserved
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // ** media_state **
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Bitfields for diskette drive media state:
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Bit(s) Description (Table M0030)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 7-6 data rate
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 00=500kbps, 01=300kbps, 10=250kbps, 11=1Mbps
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 5 double stepping required (e.g. 360kB in 1.2MB)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 4 media type established
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 3 drive capable of supporting 4MB media
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 2-0 on exit from BIOS, contains
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 000 trying 360kB in 360kB
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 001 trying 360kB in 1.2MB
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 010 trying 1.2MB in 1.2MB
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 011 360kB in 360kB established
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 100 360kB in 1.2MB established
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 101 1.2MB in 1.2MB established
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 110 reserved
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 111 all other formats/drives
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // @todo: break out drive type determination
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type = inb_cmos(0x10);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type >>= 4;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type &= 0x0f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( drive_type == 1 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 360K 5.25" drive
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0x00; // 0000 0000
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0x15; // 0001 0101
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else if ( drive_type == 2 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 1.2 MB 5.25" drive
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0x00; // 0000 0000
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0x35; // 0011 0101 // need double stepping??? (bit 5)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else if ( drive_type == 3 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 720K 3.5" drive
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0x00; // 0000 0000 ???
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0x17; // 0001 0111
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else if ( drive_type == 4 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 1.44 MB 3.5" drive
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0x00; // 0000 0000
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0x17; // 0001 0111
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else if ( drive_type == 5 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 2.88 MB 3.5" drive
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0xCC; // 1100 1100
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0xD7; // 1101 0111
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Extended floppy size uses special cmos setting
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else if ( drive_type == 14 || drive_type == 15 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // 15.6 MB 3.5" (fake) || 63.5 MB 3.5" (fake) - report same as 2.88 MB.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0xCC; // 1100 1100
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0xD7; // 1101 0111
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // not recognized
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = 0x00; // 0000 0000
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state = 0x00; // 0000 0000
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync retval = 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x008B, config_data);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync while (!floppy_read_id(drive)) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ((config_data & 0xC0) == 0x80) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // If even 250 Kbps failed, we can't do much
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync break;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync switch (config_data & 0xC0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0xC0: // 1 Mbps
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = config_data & 0x3F | 0x00;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync break;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x00: // 500 Kbps
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = config_data & 0x3F | 0x40;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync break;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x40: // 300 Kbps
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync config_data = config_data & 0x3F | 0x80;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync break;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x008B, config_data);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state_offset = 0x0090;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync media_state_offset = 0x0091;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x008B, config_data);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, media_state_offset, media_state);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return retval;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncbx_bool floppy_drive_exists(uint16_t drive)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t drive_type;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // check CMOS to see if drive exists
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // @todo: break out drive type determination
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type = inb_cmos(0x10);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type >>= 4;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type &= 0x0f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return drive_type != 0;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync}
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync//@todo: put in a header
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define AX r.gr.u.r16.ax
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define BX r.gr.u.r16.bx
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define CX r.gr.u.r16.cx
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define DX r.gr.u.r16.dx
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define SI r.gr.u.r16.si
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define DI r.gr.u.r16.di
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define BP r.gr.u.r16.bp
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define ELDX r.gr.u.r16.sp
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define DS r.ds
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define ES r.es
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#define FLAGS r.ra.flags.u.r16.flags
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsyncvoid BIOSCALL int13_diskette_function(disk_regs_t r)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync{
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t drive, num_sectors, track, sector, head;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint16_t base_address, base_count, base_es;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t page, mode_register, val8;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t return_status[7];
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint8_t drive_type, num_floppies, ah;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync uint16_t last_addr;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int i;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("%s: AX=%04x BX=%04x CX=%04x DX=%04x ES=%04x\n", __func__, AX, BX, CX, DX, ES);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync ah = GET_AH();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync switch ( ah ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x00: // diskette controller reset
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("floppy f00\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive = GET_ELDL();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive > 1) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(1); // invalid param
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(1);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // @todo: break out drive type determination
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type = inb_cmos(0x10);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive == 0)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type >>= 4;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive_type &= 0x0f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (drive_type == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x80); // drive not responding
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // force re-calibration etc.
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, 0);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync CLEAR_CF(); // successful
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_current_cyl(drive, 0); // current cylinder
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x01: // Read Diskette Status
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync CLEAR_CF();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0000, 0x0441);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x02: // Read Diskette Sectors
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x03: // Write Diskette Sectors
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync case 0x04: // Verify Diskette Sectors
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync num_sectors = GET_AL();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync track = GET_CH();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync sector = GET_CL();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync head = GET_DH();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync drive = GET_ELDL();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( (drive > 1) || (head > 1) ||
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync (num_sectors == 0) || (num_sectors > 72) ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_INFO("%s: drive>1 || head>1 ...\n", __func__);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(1);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(1);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // see if drive exists
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (floppy_drive_exists(drive) == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x80); // not responding
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // see if media in drive, and type is known
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (floppy_media_known(drive) == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (floppy_media_sense(drive) == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x0C); // Media type not found
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x0C);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (ah == 0x02) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Read Diskette Sectors
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //-----------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set up DMA controller for transfer
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //-----------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // es:bx = pointer to where to place information from diskette
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 04: DMA-1 base and current address, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 05: DMA-1 base and current count, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // @todo: merge/factor out pointer normalization
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync page = (ES >> 12); // upper 4 bits
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_es = (ES << 4); // lower 16bits contributed by ES
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_address = base_es + BX; // lower 16 bits of address
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // contributed by ES:BX
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( base_address < base_es ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // in case of carry, adjust page by 1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync page++;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_count = (num_sectors * 512) - 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // check for 64K boundary overrun
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync last_addr = base_address + base_count;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (last_addr < base_address) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x09);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x09);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("masking DMA-1 c2\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000a, 0x06);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("clear flip-flop\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000c, 0x00); // clear flip-flop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0004, base_address);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0004, base_address>>8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("clear flip-flop\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000c, 0x00); // clear flip-flop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0005, base_count);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0005, base_count>>8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("xfer buf %x bytes at %x:%x\n",
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_count, page, base_address);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 0b: DMA-1 Mode Register
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync mode_register = 0x46; // single mode, increment, autoinit disable,
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // transfer type=write, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("setting mode register\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000b, mode_register);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("setting page register\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 81: DMA-1 Page Register, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0081, page);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("unmasking DMA-1 c2\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000a, 0x02); // unmask channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //--------------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set up floppy controller for transfer
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //--------------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_prepare_controller(drive);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // send read-normal-data command (9 bytes) to controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0xe6); // e6: read normal data
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, (head << 2) | drive); // HD DR1 DR2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, track);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, head);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, sector);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 2); // 512 byte sector size
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, sector + num_sectors - 1); // last sector to read on track
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0); // Gap length
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0xff); // Gap length
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn on interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // wait on 40:3e bit 7 to become 1 or timeout (latter isn't armed so it won't happen)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x0040);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_reset_controller();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x80); // drive not ready (timeout)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = (read_byte(0x0040, 0x003e) & 0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( val8 == 0 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = 0; // separate asm from while() loop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn off interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set 40:3e bit 7 to 0
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 &= 0x7f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = floppy_wait_for_interrupt_or_timeout();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0) { /* Note! Interrupts enabled in this branch. */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_reset_controller();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x80); // drive not ready (timeout)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // check port 3f4 for accessibility to status bytes
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = inb(0x3f4);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( (val8 & 0xc0) != 0xc0 )
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_PANIC("%s: ctrl not ready\n", __func__);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // read 7 return status bytes from controller and store in BDA
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync for (i = 0; i < 7; ++i) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return_status[i] = inb(0x3f5);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x0042 + i, return_status[i]);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( (return_status[0] & 0xc0) != 0 ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x20);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x20);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef DMA_WORKAROUND
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync rep_movsw(ES :> BX, ES :> BX, num_sectors * 512 / 2);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // ??? should track be new val from return_status[3] ?
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_current_cyl(drive, track);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // AL = number of sectors read (same value as passed)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x00); // success
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync CLEAR_CF(); // success
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } else if (ah == 0x03) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // Write Diskette Sectors
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //-----------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set up DMA controller for transfer
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //-----------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // es:bx = pointer to where to place information from diskette
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 04: DMA-1 base and current address, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 05: DMA-1 base and current count, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // @todo: merge/factor out pointer normalization
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync page = (ES >> 12); // upper 4 bits
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_es = (ES << 4); // lower 16bits contributed by ES
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_address = base_es + BX; // lower 16 bits of address
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // contributed by ES:BX
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if ( base_address < base_es ) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // in case of carry, adjust page by 1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync page++;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_count = (num_sectors * 512) - 1;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // check for 64K boundary overrun
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync last_addr = base_address + base_count;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (last_addr < base_address) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x09);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x09);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors read
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("masking DMA-1 c2\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000a, 0x06);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000c, 0x00); // clear flip-flop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0004, base_address);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0004, base_address>>8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000c, 0x00); // clear flip-flop
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0005, base_count);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0005, base_count>>8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("xfer buf %x bytes at %x:%x\n",
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync base_count, page, base_address);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 0b: DMA-1 Mode Register
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync mode_register = 0x4a; // single mode, increment, autoinit disable,
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // transfer type=read, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000b, mode_register);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // port 81: DMA-1 Page Register, channel 2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x0081, page);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync BX_DEBUG_INT13_FL("unmasking DMA-1 c2\n");
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x000a, 0x02);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //--------------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set up floppy controller for transfer
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync //--------------------------------------
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_prepare_controller(drive);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // send write-normal-data command (9 bytes) to controller
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0xc5); // c5: write normal data
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, (head << 2) | drive); // HD DR1 DR2
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, track);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, head);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, sector);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 2); // 512 byte sector size
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, sector + num_sectors - 1); // last sector to write on track
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0); // Gap length
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync outb(0x03f5, 0xff); // Gap length
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn on interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_enable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // wait on 40:3e bit 7 to become 1
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync do {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x0040);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0) {
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_reset_controller();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x80); // drive not ready (timeout)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors written
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = (read_byte(0x0040, 0x003e) & 0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync } while ( val8 == 0 );
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = 0; // separate asm from while() loop @todo: why??
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // turn off interrupts
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync int_disable();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync // set 40:3e bit 7 to 0
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = read_byte(0x0040, 0x003e);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 &= 0x7f;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync write_byte(0x0040, 0x003e, val8);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#else
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync val8 = floppy_wait_for_interrupt_or_timeout();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync if (val8 == 0) { /* Note! Interrupts enabled in this branch. */
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync floppy_reset_controller();
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AH(0x80); // drive not ready (timeout)
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync set_diskette_ret_status(0x80);
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_AL(0); // no sectors written
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync SET_CF(); // error occurred
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync return;
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync }
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync#endif
4fd606d1f5abe38e1f42c38de1d2e895166bd0f4vboxsync
// check port 3f4 for accessibility to status bytes
val8 = inb(0x3f4);
if ( (val8 & 0xc0) != 0xc0 )
BX_PANIC("%s: ctrl not ready\n", __func__);
// read 7 return status bytes from controller and store in BDA
for (i = 0; i < 7; ++i) {
return_status[i] = inb(0x3f5);
write_byte(0x0040, 0x0042 + i, return_status[i]);
}
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;
} else {
// Some other problem occurred.
AX = 0x0100;
}
SET_CF();
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 == 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
// @todo: merge/factor out pointer normalization
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 seek command to controller
outb(0x03f5, 0x0f); // 0f: seek
outb(0x03f5, (head << 2) | drive); // HD DR1 DR2
outb(0x03f5, track);
// 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
#ifdef VBOX_WITH_FLOPPY_IRQ_POLLING
// turn on interrupts
int_enable();
// 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
int_disable();
// set 40:3e bit 7 to 0
val8 = read_byte(0x0040, 0x003e);
val8 &= 0x7f;
write_byte(0x0040, 0x003e, val8);
#else
val8 = floppy_wait_for_interrupt_or_timeout();
if (val8 == 0) { /* Note! Interrupts enabled in this branch. */
floppy_reset_controller();
SET_AH(0x80); // drive not ready (timeout)
set_diskette_ret_status(0x80);
SET_CF(); // error occurred
return;
}
#endif
// check port 3f4 for accessibility to status bytes
val8 = inb(0x3f4);
if ( (val8 & 0xc0) != 0xc0 )
BX_PANIC("%s: ctrl not ready\n", __func__);
// read 7 return status bytes from controller and store in BDA
for (i = 0; i < 7; ++i) {
return_status[i] = inb(0x3f5);
write_byte(0x0040, 0x0042 + i, return_status[i]);
}
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("%s: write error\n", __func__);
}
}
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;
}
// @todo: break out drive type determination
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);
SET_DH(1); // max head #
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
break;
case 2: // 1.2MB, 5.25"
CX = 0x4f0f; // 80 tracks, 15 sectors
break;
case 3: // 720KB, 3.5"
CX = 0x4f09; // 80 tracks, 9 sectors
break;
case 4: // 1.44MB, 3.5"
CX = 0x4f12; // 80 tracks, 18 sectors
break;
case 5: // 2.88MB, 3.5"
CX = 0x4f24; // 80 tracks, 36 sectors
break;
case 14: // 15.6 MB 3.5" (fake)
CX = 0xfe3f; // 255 tracks, 63 sectors
break;
case 15: // 63.5 MB 3.5" (fake)
CX = 0xfeff; // 255 tracks, 255 sectors - This works because the cylinder
break; // and sectors limits/encoding aren't checked by the BIOS
// due to copy protection schemes and such stuff.
default: // ?
BX_PANIC("%s: bad floppy type\n", __func__);
}
/* set es & di to point to 11 byte diskette param table in ROM */
ES = 0xF000; // @todo: any way to make this relocatable?
DI = get_floppy_dpt(drive_type);
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;
}
// @todo: break out drive type determination
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 if (drive_type > 1) {
SET_AH(2); // drive present, supports change line
} 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("%s: unsupported AH=%02x\n", __func__, 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 BIOSCALL int13_diskette_function(disk_regs_t r)
{
uint8_t 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
#if 0
void determine_floppy_media(uint16_t drive)
{
uint8_t 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