v86 / src /floppy.js
peterpeter8585's picture
Upload 553 files
8df6da4 verified
// v86 Floppy Disk Controller emulation
//
// This file is licensed under both BSD and MIT, see LICENSE and LICENSE.MIT.
//
// Links
// - Intel 82078 44 Pin CHMOS Single-Chip Floppy Disk Controller
// https://wiki.qemu.org/images/f/f0/29047403.pdf
// - qemu: fdc.c
// https://github.com/qemu/qemu/blob/master/hw/block/fdc.c
// - Programming Floppy Disk Controllers
// https://www.isdaman.com/alsos/hardware/fdc/floppy.htm
// - OSDev: Floppy Disk Controller
// https://wiki.osdev.org/Floppy_Disk_Controller
import { LOG_FLOPPY } from "./const.js";
import { h } from "./lib.js";
import { dbg_assert, dbg_log } from "./log.js";
import { CMOS_FLOPPY_DRIVE_TYPE } from "./rtc.js";
import { SyncBuffer } from "./buffer.js";
// For Types Only
import { CPU } from "./cpu.js";
import { DMA } from "./dma.js";
import { IO } from "./io.js";
// System resources
const FDC_IRQ_CHANNEL = 6;
const FDC_DMA_CHANNEL = 2;
/**
* Floppy drive types
* CMOS register 0x10 bits: upper nibble: fda, lower nibble: fdb
* @see {@link https://wiki.osdev.org/CMOS#Register_0x10}
*/
const CMOS_FDD_TYPE_NO_DRIVE = 0x0; // no floppy drive
const CMOS_FDD_TYPE_360 = 0x1; // 360 KB 5"1/4 drive
const CMOS_FDD_TYPE_1200 = 0x2; // 1.2 MB 5"1/4 drive
const CMOS_FDD_TYPE_720 = 0x3; // 720 KB 3"1/2 drive
const CMOS_FDD_TYPE_1440 = 0x4; // 1.44 MB 3"1/2 drive
const CMOS_FDD_TYPE_2880 = 0x5; // 2.88 MB 3"1/2 drive
// Physical floppy disk size identifier of each drive type
const CMOS_FDD_TYPE_MEDIUM = {
[CMOS_FDD_TYPE_NO_DRIVE]: 0, // no disk
[CMOS_FDD_TYPE_360]: 525, // 5"1/4 disk
[CMOS_FDD_TYPE_1200]: 525, // 5"1/4 disk
[CMOS_FDD_TYPE_720]: 350, // 3"1/2 disk
[CMOS_FDD_TYPE_1440]: 350, // 3"1/2 disk
[CMOS_FDD_TYPE_2880]: 350, // 3"1/2 disk
};
// Floppy Controller PIO Register offsets (base: 0x3F0/0x370, offset 0x6 is reserved for ATA IDE)
const REG_SRA = 0x0; // R, Status Register A (SRA)
const REG_SRB = 0x1; // R, Status Register B (SRB)
const REG_DOR = 0x2; // RW, Digital Output Register (DOR)
const REG_TDR = 0x3; // RW, Tape Drive Register (TDR)
const REG_MSR = 0x4; // R, Main Status Register (MSR)
const REG_DSR = 0x4; // W, Datarate Select Register (DSR)
const REG_FIFO = 0x5; // RW, W: command bytes, R: response bytes (FIFO)
const REG_DIR = 0x7; // R, Digital Input Register (DIR)
const REG_CCR = 0x7; // W, Configuration Control Register (CCR)
// Status Register A (SRA) bits
const SRA_NDRV2 = 0x40; // true: second drive is not connected
const SRA_INTPEND = 0x80; // true: interrupt pending
// Status Register B (SRB) bits
const SRB_MTR0 = 0x1; // follows DOR.DOR_MOT0
const SRB_MTR1 = 0x2; // follows DOR.DOR_MOT1
const SRB_DR0 = 0x20; // follows DOR.DOR_SEL_LO
const SRB_RESET = 0xc0; // magic value after reset
// Digital Output Register (DOR) bits
const DOR_SEL_LO = 0x1; // lower bit of selected FDD number
const DOR_SEL_HI = 0x2; // upper bit of selected FDD number
const DOR_NRESET = 0x4; // true: normal controller mode, false: reset mode ("not RESET")
const DOR_DMAEN = 0x8; // true: use DMA
const DOR_MOTEN0 = 0x10; // true: enable motor of FDD0
const DOR_MOTEN1 = 0x20; // true: enable motor of FDD1
const DOR_MOTEN2 = 0x40; // true: enable motor of FDD2
const DOR_MOTEN3 = 0x80; // true: enable motor of FDD3
const DOR_SELMASK = 0x01;
// Tape Drive Register (TDR) bits
const TDR_BOOTSEL = 0x4;
// Main Status Register (MSR) bits
const MSR_FDD0 = 0x1; // true: FDD0 is busy in seek mode
const MSR_FDD1 = 0x2; // true: FDD1 is busy in seek mode
const MSR_FDD2 = 0x4; // true: FDD2 is busy in seek mode
const MSR_FDD3 = 0x8; // true: FDD3 is busy in seek mode
const MSR_CMDBUSY = 0x10; // true: FDC busy, Read/Write command in progress, cleared at end of Result phase
const MSR_NDMA = 0x20; // Non-DMA mode, set in Execution phase of PIO mode read/write commands only.
const MSR_DIO = 0x40; // Data Input/Output, true: FDC has data for CPU, false: FDC expects data from CPU
const MSR_RQM = 0x80; // true: DATA register is ready for I/O
// Datarate Select Register (DSR) bits
const DSR_DRATEMASK = 0x3;
const DSR_PWRDOWN = 0x40;
const DSR_SWRESET = 0x80;
// Digital Input Register (DIR) bits
const DIR_DOOR = 0x80; // true: No disk or disk changed since last command
// Status Register 0 (SR0) bits
const SR0_DS0 = 0x1; // Drive select 0..3 lower bit
const SR0_DS1 = 0x2; // Drive select 0..3 upper bit
const SR0_HEAD = 0x4; // true: Use 2nd head
const SR0_EQPMT = 0x10; // (?)
const SR0_SEEK = 0x20; // (?)
const SR0_ABNTERM = 0x40; // true: Command failed
const SR0_INVCMD = 0x80; // true: Unknown/unimplemented command code
const SR0_RDYCHG = SR0_ABNTERM | SR0_INVCMD; // 0xC0 (?)
// Status Register 1 (SR1) bits
const SR1_MA = 0x1; // true: Missing address mark error
const SR1_NW = 0x2; // true: Not writable error
const SR1_EC = 0x80; // true: End of cylinder error
// Status Register 2 (SR2) bits
const SR2_SNS = 0x4; // true: Scan not satisfied (?)
const SR2_SEH = 0x8; // true: Scan equal hit (?)
/**
* FDC command codes
* We declare all known floppy commands but implement only the subset that
* we actually observe in the field. See also build_cmd_lookup_table().
* @see {@link https://github.com/qemu/qemu/blob/6e1571533fd92bec67e5ab9b1dd1e15032925757/hw/block/fdc.c#L619}
*/
const CMD_READ_TRACK = 0x2; // unimplemented
const CMD_SPECIFY = 0x3;
const CMD_SENSE_DRIVE_STATUS = 0x4;
const CMD_WRITE = 0x5;
const CMD_READ = 0x6;
const CMD_RECALIBRATE = 0x7;
const CMD_SENSE_INTERRUPT_STATUS = 0x8;
const CMD_WRITE_DELETED_DATA = 0x9; // unimplemented
const CMD_READ_ID = 0xa;
const CMD_READ_DELETED_DATA = 0xc; // unimplemented
const CMD_FORMAT_TRACK = 0xd;
const CMD_DUMP_REGS = 0xe;
const CMD_SEEK = 0xf;
const CMD_VERSION = 0x10;
const CMD_SCAN_EQUAL = 0x11; // unimplemented
const CMD_PERPENDICULAR_MODE = 0x12;
const CMD_CONFIGURE = 0x13;
const CMD_LOCK = 0x14;
const CMD_VERIFY = 0x16; // unimplemented
const CMD_POWERDOWN_MODE = 0x17; // unimplemented
const CMD_PART_ID = 0x18;
const CMD_SCAN_LOW_OR_EQUAL = 0x19; // unimplemented
const CMD_SCAN_HIGH_OR_EQUAL = 0x1d; // unimplemented
const CMD_SAVE = 0x2e; // unimplemented
const CMD_OPTION = 0x33; // unimplemented
const CMD_RESTORE = 0x4e; // unimplemented
const CMD_DRIVE_SPECIFICATION = 0x8e; // unimplemented
const CMD_RELATIVE_SEEK_OUT = 0x8f; // unimplemented
const CMD_FORMAT_AND_WRITE = 0xcd; // unimplemented
const CMD_RELATIVE_SEEK_IN = 0xcf; // unimplemented
// FDC command flags
const CMD_FLAG_MULTI_TRACK = 0x1; // MT: multi-track selector (use both heads) in READ/WRITE
// FDC command execution phases
const CMD_PHASE_COMMAND = 1;
const CMD_PHASE_EXECUTION = 2;
const CMD_PHASE_RESULT = 3;
// FDC config bits
const CONFIG_PRETRK = 0xff; // Pre-compensation set to track 0
const CONFIG_FIFOTHR = 0x0f; // FIFO threshold set to 1 byte
const CONFIG_POLL = 0x10; // Poll enabled
const CONFIG_EFIFO = 0x20; // FIFO disabled
const CONFIG_EIS = 0x40; // No implied seeks
// Number of CMD_SENSE_INTERRUPT_STATUS expected after reset
const RESET_SENSE_INT_MAX = 4;
// Sector size
const SECTOR_SIZE = 512; // fixed size of 512 bytes/sector
const SECTOR_SIZE_CODE = 2; // sector size code 2: 512 bytes/sector
// class FloppyController ----------------------------------------------------
/**
* @constructor
*
* @param {CPU} cpu
* @param {SyncBuffer|Uint8Array|null|undefined} fda_image
* @param {SyncBuffer|Uint8Array|null|undefined} fdb_image
* @param {Object=} fdc_config
*
* Structure and defaults of optional configuration object fdc_config:
*
* fdc_config = {
* fda: { drive_type: undefined, read_only: false },
* fdb: { drive_type: undefined, read_only: false }
* }
*
* drive_type:
* Fixed drive type code whether or not a buffer is defined:
* 0: no floppy drive
* 1: 360 KB 5"1/4 drive
* 2: 1.2 MB 5"1/4 drive
* 3: 720 KB 3"1/2 drive
* 4: 1.44 MB 3"1/2 drive (default)
* 5: 2.88 MB 3"1/2 drive
* If undefined, the drive type is either derived from the given
* buffer or set to the default of 4 if no buffer is specified.
* read_only:
* If true, treat the given disk image as write-protected.
* Ignored if no disk image is provided. Default: false.
*
* NOTE: To hide fdb from the guest set its drive_type to 0, i.e.:
*
* fdc_config = { fdb: { drive_type: 0 } }
*/
export function FloppyController(cpu, fda_image, fdb_image, fdc_config)
{
/** @const @type {IO|undefined} */
this.io = cpu.io;
/** @const @type {CPU} */
this.cpu = cpu;
/** @const @type {DMA} */
this.dma = cpu.devices.dma;
/** @const */
this.cmd_table = this.build_cmd_lookup_table();
this.sra = 0;
this.srb = SRB_RESET;
this.dor = DOR_NRESET | DOR_DMAEN;
this.tdr = 0;
this.msr = MSR_RQM;
this.dsr = 0;
this.cmd_phase = CMD_PHASE_COMMAND;
this.cmd_code = 0;
this.cmd_flags = 0;
this.cmd_buffer = new Uint8Array(17); // CMD_RESTORE has 17 argument bytes
this.cmd_cursor = 0;
this.cmd_remaining = 0;
this.response_data = new Uint8Array(15); // CMD_SAVE response size is 15 bytes
this.response_cursor = 0;
this.response_length = 0;
this.status0 = 0;
this.status1 = 0;
this.curr_drive_no = 0; // was: this.drive; qemu: fdctrl->cur_drv
this.reset_sense_int_count = 0; // see SENSE INTERRUPT
this.locked = false; // see LOCK
this.step_rate_interval = 0; // see SPECIFY, qemu: timer0
this.head_load_time = 0; // see SPECIFY, qemu: timer1
this.fdc_config = CONFIG_EIS | CONFIG_EFIFO; // see CONFIGURE, qemu: config
this.precomp_trk = 0; // see CONFIGURE
this.eot = 0; // see READ/WRITE
this.drives = [
new FloppyDrive("fda", fdc_config?.fda, fda_image, CMOS_FDD_TYPE_1440),
new FloppyDrive("fdb", fdc_config?.fdb, fdb_image, CMOS_FDD_TYPE_1440)
];
Object.seal(this);
// To make the floppy drives visible to the guest OS we MUST write a
// drive type other than 0 (CMOS_FDD_TYPE_NO_DRIVE) to either nibble of
// CMOS register 0x10 before the guest is started (CMOS registers are
// usually read only once at startup).
this.cpu.devices.rtc.cmos_write(CMOS_FLOPPY_DRIVE_TYPE, (this.drives[0].drive_type << 4) | this.drives[1].drive_type);
const fdc_io_base = 0x3F0; // alt: 0x370
this.io.register_read(fdc_io_base | REG_SRA, this, this.read_reg_sra);
this.io.register_read(fdc_io_base | REG_SRB, this, this.read_reg_srb);
this.io.register_read(fdc_io_base | REG_DOR, this, this.read_reg_dor);
this.io.register_read(fdc_io_base | REG_TDR, this, this.read_reg_tdr);
this.io.register_read(fdc_io_base | REG_MSR, this, this.read_reg_msr);
this.io.register_read(fdc_io_base | REG_FIFO, this, this.read_reg_fifo);
this.io.register_read(fdc_io_base | REG_DIR, this, this.read_reg_dir);
this.io.register_write(fdc_io_base | REG_DOR, this, this.write_reg_dor);
this.io.register_write(fdc_io_base | REG_TDR, this, this.write_reg_tdr);
this.io.register_write(fdc_io_base | REG_DSR, this, this.write_reg_dsr);
this.io.register_write(fdc_io_base | REG_FIFO, this, this.write_reg_fifo);
this.io.register_write(fdc_io_base | REG_CCR, this, this.write_reg_ccr);
dbg_log("floppy controller ready", LOG_FLOPPY);
}
FloppyController.prototype.build_cmd_lookup_table = function()
{
/**
* NOTE: The order of items in the table below is significant.
* @see {@link https://github.com/qemu/qemu/blob/aec6836c73403cffa56b9a4c5556451ee16071fe/hw/block/fdc.c#L2160}
*/
const CMD_DESCRIPTOR = [
{ code: CMD_READ, mask: 0x1f, argc: 8, name: "READ", handler: this.exec_read },
{ code: CMD_WRITE, mask: 0x3f, argc: 8, name: "WRITE", handler: this.exec_write },
{ code: CMD_SEEK, mask: 0xff, argc: 2, name: "SEEK", handler: this.exec_seek },
{ code: CMD_SENSE_INTERRUPT_STATUS, mask: 0xff, argc: 0, name: "SENSE INTERRUPT STATUS", handler: this.exec_sense_interrupt_status },
{ code: CMD_RECALIBRATE, mask: 0xff, argc: 1, name: "RECALIBRATE", handler: this.exec_recalibrate },
{ code: CMD_FORMAT_TRACK, mask: 0xbf, argc: 5, name: "FORMAT TRACK", handler: this.exec_format_track },
{ code: CMD_READ_TRACK, mask: 0xbf, argc: 8, name: "READ TRACK", handler: this.exec_unimplemented },
{ code: CMD_RESTORE, mask: 0xff, argc: 17, name: "RESTORE", handler: this.exec_unimplemented },
{ code: CMD_SAVE, mask: 0xff, argc: 0, name: "SAVE", handler: this.exec_unimplemented },
{ code: CMD_READ_DELETED_DATA, mask: 0x1f, argc: 8, name: "READ DELETED DATA", handler: this.exec_unimplemented },
{ code: CMD_SCAN_EQUAL, mask: 0x1f, argc: 8, name: "SCAN EQUAL", handler: this.exec_unimplemented },
{ code: CMD_VERIFY, mask: 0x1f, argc: 8, name: "VERIFY", handler: this.exec_unimplemented },
{ code: CMD_SCAN_LOW_OR_EQUAL, mask: 0x1f, argc: 8, name: "SCAN LOW OR EQUAL", handler: this.exec_unimplemented },
{ code: CMD_SCAN_HIGH_OR_EQUAL, mask: 0x1f, argc: 8, name: "SCAN HIGH OR EQUAL", handler: this.exec_unimplemented },
{ code: CMD_WRITE_DELETED_DATA, mask: 0x3f, argc: 8, name: "WRITE DELETED DATA", handler: this.exec_unimplemented },
{ code: CMD_READ_ID, mask: 0xbf, argc: 1, name: "READ ID", handler: this.exec_read_id },
{ code: CMD_SPECIFY, mask: 0xff, argc: 2, name: "SPECIFY", handler: this.exec_specify },
{ code: CMD_SENSE_DRIVE_STATUS, mask: 0xff, argc: 1, name: "SENSE DRIVE STATUS", handler: this.exec_sense_drive_status },
{ code: CMD_PERPENDICULAR_MODE, mask: 0xff, argc: 1, name: "PERPENDICULAR MODE", handler: this.exec_perpendicular_mode },
{ code: CMD_CONFIGURE, mask: 0xff, argc: 3, name: "CONFIGURE", handler: this.exec_configure },
{ code: CMD_POWERDOWN_MODE, mask: 0xff, argc: 2, name: "POWERDOWN MODE", handler: this.exec_unimplemented },
{ code: CMD_OPTION, mask: 0xff, argc: 1, name: "OPTION", handler: this.exec_unimplemented },
{ code: CMD_DRIVE_SPECIFICATION, mask: 0xff, argc: 5, name: "DRIVE SPECIFICATION", handler: this.exec_unimplemented },
{ code: CMD_RELATIVE_SEEK_OUT, mask: 0xff, argc: 2, name: "RELATIVE SEEK OUT", handler: this.exec_unimplemented },
{ code: CMD_FORMAT_AND_WRITE, mask: 0xff, argc: 10, name: "FORMAT AND WRITE", handler: this.exec_unimplemented },
{ code: CMD_RELATIVE_SEEK_IN, mask: 0xff, argc: 2, name: "RELATIVE SEEK IN", handler: this.exec_unimplemented },
{ code: CMD_LOCK, mask: 0x7f, argc: 0, name: "LOCK", handler: this.exec_lock },
{ code: CMD_DUMP_REGS, mask: 0xff, argc: 0, name: "DUMP REGISTERS", handler: this.exec_dump_regs },
{ code: CMD_VERSION, mask: 0xff, argc: 0, name: "VERSION", handler: this.exec_version },
{ code: CMD_PART_ID, mask: 0xff, argc: 0, name: "PART ID", handler: this.exec_part_id },
{ code: 0, mask: 0x00, argc: 0, name: "UNKNOWN COMMAND", handler: this.exec_unimplemented }, // default handler
];
const cmd_table = new Array(256);
for(let i = CMD_DESCRIPTOR.length-1; i >= 0; i--)
{
const cmd_desc = CMD_DESCRIPTOR[i];
if(cmd_desc.mask === 0xff)
{
cmd_table[cmd_desc.code] = cmd_desc;
}
else
{
for(let j = 0; j < 256; j++)
{
if((j & cmd_desc.mask) === cmd_desc.code)
{
cmd_table[j] = cmd_desc;
}
}
}
}
return cmd_table;
};
FloppyController.prototype.raise_irq = function(reason)
{
if(!(this.sra & SRA_INTPEND))
{
this.cpu.device_raise_irq(FDC_IRQ_CHANNEL);
this.sra |= SRA_INTPEND;
dbg_log("IRQ raised, reason: " + reason, LOG_FLOPPY);
}
this.reset_sense_int_count = 0;
};
FloppyController.prototype.lower_irq = function(reason)
{
this.status0 = 0;
if(this.sra & SRA_INTPEND)
{
this.cpu.device_lower_irq(FDC_IRQ_CHANNEL);
this.sra &= ~SRA_INTPEND;
dbg_log("IRQ lowered, reason: " + reason, LOG_FLOPPY);
}
};
FloppyController.prototype.set_curr_drive_no = function(curr_drive_no)
{
this.curr_drive_no = curr_drive_no & 1;
return this.drives[this.curr_drive_no];
};
FloppyController.prototype.enter_command_phase = function()
{
this.cmd_phase = CMD_PHASE_COMMAND;
this.cmd_cursor = 0;
this.cmd_remaining = 0;
this.msr &= ~(MSR_CMDBUSY | MSR_DIO);
this.msr |= MSR_RQM;
};
FloppyController.prototype.enter_result_phase = function(fifo_len)
{
this.cmd_phase = CMD_PHASE_RESULT;
this.response_cursor = 0;
this.response_length = fifo_len;
this.msr |= MSR_CMDBUSY | MSR_RQM | MSR_DIO;
};
FloppyController.prototype.reset_fdc = function()
{
dbg_log("resetting controller", LOG_FLOPPY);
this.lower_irq("controller reset");
this.sra = 0; // NOTE: set SRA to SRA_NDRV2 if fdb does not exist
this.srb = SRB_RESET;
this.dor = DOR_NRESET | DOR_DMAEN;
this.msr = MSR_RQM;
this.curr_drive_no = 0;
this.status0 |= SR0_RDYCHG;
this.response_cursor = 0;
this.response_length = 0;
this.drives[0].seek(0, 0, 1);
this.drives[1].seek(0, 0, 1);
// raise interrupt
this.enter_command_phase();
this.raise_irq("controller reset");
this.reset_sense_int_count = RESET_SENSE_INT_MAX;
};
// Register I/O callbacks ----------------------------------------------------
FloppyController.prototype.read_reg_sra = function()
{
dbg_log("SRA read: " + h(this.sra), LOG_FLOPPY);
return this.sra;
};
FloppyController.prototype.read_reg_srb = function()
{
dbg_log("SRB read: " + h(this.srb), LOG_FLOPPY);
return this.srb;
};
FloppyController.prototype.read_reg_dor = function()
{
const dor_byte = (this.dor & ~(DOR_SEL_LO|DOR_SEL_HI)) | this.curr_drive_no;
dbg_log("DOR read: " + h(dor_byte), LOG_FLOPPY);
return dor_byte;
};
FloppyController.prototype.read_reg_tdr = function()
{
dbg_log("TDR read: " + h(this.tdr), LOG_FLOPPY);
return this.tdr;
};
FloppyController.prototype.read_reg_msr = function()
{
dbg_log("MSR read: " + h(this.msr), LOG_FLOPPY);
this.dsr &= ~DSR_PWRDOWN;
this.dor |= DOR_NRESET;
return this.msr;
};
FloppyController.prototype.read_reg_fifo = function()
{
this.dsr &= ~DSR_PWRDOWN;
if(!(this.msr & MSR_RQM) || !(this.msr & MSR_DIO))
{
dbg_log("FIFO read rejected: controller not ready for reading", LOG_FLOPPY);
return 0;
}
else if(this.cmd_phase !== CMD_PHASE_RESULT)
{
dbg_log("FIFO read rejected: floppy controller not in RESULT phase, phase: " + this.cmd_phase, LOG_FLOPPY);
return 0;
}
if(this.response_cursor < this.response_length)
{
const fifo_byte = this.response_data[this.response_cursor++];
if(this.response_cursor === this.response_length)
{
const lower_irq_reason = DEBUG ? "end of " + this.cmd_table[this.cmd_code].name + " response" : "";
this.msr &= ~MSR_RQM;
this.enter_command_phase();
this.lower_irq(lower_irq_reason);
}
return fifo_byte;
}
else
{
dbg_log("FIFO read: empty", LOG_FLOPPY);
return 0;
}
};
FloppyController.prototype.read_reg_dir = function()
{
const curr_drive = this.drives[this.curr_drive_no];
const dir_byte = curr_drive.media_changed ? DIR_DOOR : 0;
dbg_log("DIR read: " + h(dir_byte), LOG_FLOPPY);
return dir_byte;
};
FloppyController.prototype.write_reg_dor = function(dor_byte)
{
// update motor and drive bits in Status Register B
this.srb = (this.srb & ~(SRB_MTR0 | SRB_MTR1 | SRB_DR0)) |
(dor_byte & DOR_MOTEN0 ? SRB_MTR0 : 0) |
(dor_byte & DOR_MOTEN1 ? SRB_MTR1 : 0) |
(dor_byte & DOR_SEL_LO ? SRB_DR0 : 0);
// RESET-state transitions
if(this.dor & DOR_NRESET)
{
if(!(dor_byte & DOR_NRESET))
{
dbg_log("enter RESET state", LOG_FLOPPY);
}
}
else
{
if(dor_byte & DOR_NRESET)
{
this.reset_fdc();
this.dsr &= ~DSR_PWRDOWN;
dbg_log("exit RESET state", LOG_FLOPPY);
}
}
// select current drive
const new_drive_no = dor_byte & (DOR_SEL_LO|DOR_SEL_HI);
dbg_log("DOR write: " + h(dor_byte) + ", motors: " + h(dor_byte >> 4) +
", dma: " + !!(dor_byte & DOR_DMAEN) + ", reset: " + !(dor_byte & DOR_NRESET) +
", drive: " + new_drive_no, LOG_FLOPPY);
if(new_drive_no > 1)
{
dbg_log("*** WARNING: floppy drive number " + new_drive_no + " not implemented!", LOG_FLOPPY);
}
this.curr_drive_no = new_drive_no & DOR_SEL_LO;
this.dor = dor_byte;
};
FloppyController.prototype.write_reg_tdr = function(tdr_byte)
{
if(!(this.dor & DOR_NRESET))
{
dbg_log("TDR write " + h(tdr_byte) + " rejected: Floppy controller in RESET mode!", LOG_FLOPPY);
return;
}
dbg_log("TDR write: " + h(tdr_byte), LOG_FLOPPY);
this.tdr = tdr_byte & TDR_BOOTSEL; // Disk boot selection indicator
};
FloppyController.prototype.write_reg_dsr = function(dsr_byte)
{
if(!(this.dor & DOR_NRESET))
{
dbg_log("DSR write: " + h(dsr_byte) + " rejected: Floppy controller in RESET mode!", LOG_FLOPPY);
return;
}
dbg_log("DSR write: " + h(dsr_byte), LOG_FLOPPY);
if(dsr_byte & DSR_SWRESET)
{
this.dor &= ~DOR_NRESET;
this.reset_fdc();
this.dor |= DOR_NRESET;
}
if(dsr_byte & DSR_PWRDOWN)
{
this.reset_fdc();
}
this.dsr = dsr_byte;
};
FloppyController.prototype.write_reg_fifo = function(fifo_byte)
{
this.dsr &= ~DSR_PWRDOWN;
if(!(this.dor & DOR_NRESET))
{
dbg_log("FIFO write " + h(fifo_byte) + " rejected: floppy controller in RESET mode!", LOG_FLOPPY);
return;
}
else if(!(this.msr & MSR_RQM) || (this.msr & MSR_DIO))
{
dbg_log("FIFO write " + h(fifo_byte) + " rejected: controller not ready for writing", LOG_FLOPPY);
return;
}
else if(this.cmd_phase !== CMD_PHASE_COMMAND)
{
dbg_log("FIFO write " + h(fifo_byte) + " rejected: floppy controller not in COMMAND phase, phase: " + this.cmd_phase, LOG_FLOPPY);
return;
}
if(this.cmd_remaining === 0)
{
// start reading command, fifo_byte contains the command code
const cmd_desc = this.cmd_table[fifo_byte];
this.cmd_code = fifo_byte;
this.cmd_remaining = cmd_desc.argc;
this.cmd_cursor = 0;
this.cmd_flags = 0;
if((cmd_desc.code === CMD_READ || cmd_desc.code === CMD_WRITE) && (this.cmd_code & 0x80)) // 0x80: Multi-track (MT)
{
this.cmd_flags |= CMD_FLAG_MULTI_TRACK;
}
if(this.cmd_remaining)
{
this.msr |= MSR_RQM;
}
this.msr |= MSR_CMDBUSY;
}
else
{
// continue reading command, fifo_byte contains an argument value
this.cmd_buffer[this.cmd_cursor++] = fifo_byte;
this.cmd_remaining--;
}
if(this.cmd_remaining === 0)
{
// done reading command: execute
this.cmd_phase = CMD_PHASE_EXECUTION;
const cmd_desc = this.cmd_table[this.cmd_code];
const args = this.cmd_buffer.slice(0, this.cmd_cursor);
if(DEBUG)
{
const args_hex = [];
for(const arg of args)
{
args_hex.push(h(arg, 2));
}
dbg_log("FD command " + h(this.cmd_code) + ": " + cmd_desc.name + "(" + args_hex.join(", ") + ")", LOG_FLOPPY);
}
cmd_desc.handler.call(this, args);
}
};
FloppyController.prototype.write_reg_ccr = function(ccr_byte)
{
if(!(this.dor & DOR_NRESET))
{
dbg_log("CCR write: " + h(ccr_byte) + " rejected: Floppy controller in RESET mode!", LOG_FLOPPY);
return;
}
dbg_log("CCR write: " + h(ccr_byte), LOG_FLOPPY);
// only the rate selection bits used in AT mode, and we store those in the DSR
this.dsr = (this.dsr & ~DSR_DRATEMASK) | (ccr_byte & DSR_DRATEMASK);
};
// Floppy command handler ----------------------------------------------------
FloppyController.prototype.exec_unimplemented = function(args)
{
dbg_assert(false, "Unimplemented floppy command code " + h(this.cmd_code) + "!");
this.status0 = SR0_INVCMD;
this.response_data[0] = this.status0;
// no interrupt
this.enter_result_phase(1);
};
FloppyController.prototype.exec_read = function(args)
{
this.start_read_write(args, false);
};
FloppyController.prototype.exec_write = function(args)
{
this.start_read_write(args, true);
};
FloppyController.prototype.exec_seek = function(args)
{
const curr_drive = this.set_curr_drive_no(args[0] & DOR_SELMASK);
const track = args[1];
this.enter_command_phase();
curr_drive.seek(curr_drive.curr_head, track, curr_drive.curr_sect);
// raise interrupt without response
this.status0 |= SR0_SEEK;
this.raise_irq("SEEK command");
};
FloppyController.prototype.exec_sense_interrupt_status = function(args)
{
const curr_drive = this.drives[this.curr_drive_no];
let status0;
if(this.reset_sense_int_count > 0)
{
const drv_nr = RESET_SENSE_INT_MAX - this.reset_sense_int_count--;
status0 = SR0_RDYCHG | drv_nr;
}
else if(this.sra & SRA_INTPEND)
{
status0 = (this.status0 & ~(SR0_HEAD | SR0_DS1 | SR0_DS0)) | this.curr_drive_no;
}
else
{
dbg_log("No interrupt pending, aborting SENSE INTERRUPT command!", LOG_FLOPPY);
this.response_data[0] = SR0_INVCMD;
this.enter_result_phase(1);
return;
}
this.response_data[0] = status0;
this.response_data[1] = curr_drive.curr_track;
// lower interrupt
this.enter_result_phase(2);
this.lower_irq("SENSE INTERRUPT command");
this.status0 = SR0_RDYCHG;
};
FloppyController.prototype.exec_recalibrate = function(args)
{
const curr_drive = this.set_curr_drive_no(args[0] & DOR_SELMASK);
curr_drive.seek(0, 0, 1);
// raise interrupt without response
this.enter_command_phase();
this.status0 |= SR0_SEEK;
this.raise_irq("RECALIBRATE command");
};
FloppyController.prototype.exec_format_track = function(args)
{
const curr_drive = this.set_curr_drive_no(args[0] & DOR_SELMASK);
let status0 = 0, status1 = 0;
if(curr_drive.read_only)
{
status0 = SR0_ABNTERM | SR0_SEEK;
status1 = SR1_NW;
}
// raise interrupt
this.end_read_write(status0, status1, 0);
};
FloppyController.prototype.exec_read_id = function(args)
{
const head_sel = args[0];
const curr_drive = this.drives[this.curr_drive_no];
curr_drive.curr_head = (head_sel >> 2) & 1;
if(curr_drive.max_sect !== 0)
{
curr_drive.curr_sect = (curr_drive.curr_sect % curr_drive.max_sect) + 1;
}
// raise interrupt
this.end_read_write(0, 0, 0);
};
FloppyController.prototype.exec_specify = function(args)
{
const hut_srt = args[0]; // 0..3: Head Unload Time (HUT), 4..7: Step Rate Interval (SRT)
const nd_hlt = args[1]; // 0: Non-DMA mode flag (ND), 1..7: Head Load Time (HLT)
this.step_rate_interval = hut_srt >> 4;
this.head_load_time = nd_hlt >> 1;
if(nd_hlt & 0x1)
{
this.dor &= ~DOR_DMAEN;
}
else
{
this.dor |= DOR_DMAEN;
}
// no interrupt or response
this.enter_command_phase();
};
FloppyController.prototype.exec_sense_drive_status = function(args)
{
const drv_sel = args[0];
const curr_drive = this.set_curr_drive_no(drv_sel & DOR_SELMASK);
curr_drive.curr_head = (drv_sel >> 2) & 1;
this.response_data[0] = (curr_drive.read_only ? 0x40 : 0) | // response byte is Status Register 3
(curr_drive.curr_track === 0 ? 0x10 : 0) |
(curr_drive.curr_head << 2) |
this.curr_drive_no |
0x28; // bits 3 and 5 unused, always "1"
// no interrupt
this.enter_result_phase(1);
};
FloppyController.prototype.exec_perpendicular_mode = function(args)
{
const perp_mode = args[0];
if(perp_mode & 0x80) // 0x80: OW, bits D0 and D1 can be overwritten
{
const curr_drive = this.drives[this.curr_drive_no];
curr_drive.perpendicular = perp_mode & 0x7;
}
// no interrupt or response
this.enter_command_phase();
};
FloppyController.prototype.exec_configure = function(args)
{
// args[0] is always 0
this.fdc_config = args[1];
this.precomp_trk = args[2];
// no interrupt or response
this.enter_command_phase();
};
FloppyController.prototype.exec_lock = function(args)
{
if(this.cmd_code & 0x80)
{
// LOCK command
this.locked = true;
this.response_data[0] = 0x10;
}
else
{
// UNLOCK command
this.locked = false;
this.response_data[0] = 0;
}
// no interrupt
this.enter_result_phase(1);
};
FloppyController.prototype.exec_dump_regs = function(args)
{
const curr_drive = this.drives[this.curr_drive_no];
// drive positions
this.response_data[0] = this.drives[0].curr_track;
this.response_data[1] = this.drives[1].curr_track;
this.response_data[2] = 0;
this.response_data[3] = 0;
// timers
this.response_data[4] = this.step_rate_interval;
this.response_data[5] = (this.head_load_time << 1) | ((this.dor & DOR_DMAEN) ? 1 : 0);
this.response_data[6] = curr_drive.max_sect;
this.response_data[7] = (this.locked ? 0x80 : 0) | (curr_drive.perpendicular << 2);
this.response_data[8] = this.fdc_config;
this.response_data[9] = this.precomp_trk;
// no interrupt
this.enter_result_phase(10);
};
FloppyController.prototype.exec_version = function(args)
{
this.response_data[0] = 0x90; // 0x80: Standard controller, 0x81: Intel 82077, 0x90: Intel 82078
// no interrupt
this.enter_result_phase(1);
};
FloppyController.prototype.exec_part_id = function(args)
{
this.response_data[0] = 0x41; // Stepping 1 (PS/2 mode)
// no interrupt
this.enter_result_phase(1);
};
// ---------------------------------------------------------------------------
FloppyController.prototype.start_read_write = function(args, do_write)
{
const curr_drive = this.set_curr_drive_no(args[0] & DOR_SELMASK);
const track = args[1];
const head = args[2];
const sect = args[3];
const ssc = args[4]; // sector size code 0..7 (0:128, 1:256, 2:512, ..., 7:16384 bytes/sect)
const eot = args[5]; // last sector number of current track
const dtl = args[7] < 128 ? args[7] : 128; // data length in bytes if ssc is 0, else unused
switch(curr_drive.seek(head, track, sect))
{
case 2: // error: sect too big
this.end_read_write(SR0_ABNTERM, 0, 0);
this.response_data[3] = track;
this.response_data[4] = head;
this.response_data[5] = sect;
return;
case 3: // error: track too big
this.end_read_write(SR0_ABNTERM, SR1_EC, 0);
this.response_data[3] = track;
this.response_data[4] = head;
this.response_data[5] = sect;
return;
case 1: // track changed
this.status0 |= SR0_SEEK;
break;
}
const sect_size = 128 << (ssc > 7 ? 7 : ssc); // sector size in bytes
const sect_start = curr_drive.chs2lba(track, head, sect); // linear start sector
const data_offset = sect_start * sect_size; // data offset in bytes
let data_length; // data length in bytes
if(sect_size === 128)
{
// if requested data length (dtl) is < 128:
// - READ: return only dtl bytes, skipping the sector's remaining bytes (OK)
// - WRITE: we must fill the sector's remaining bytes with 0 (TODO!)
if(do_write && dtl < 128)
{
dbg_assert(false, "dtl=" + dtl + " is less than 128, zero-padding is still unimplemented!");
}
data_length = dtl;
}
else
{
if(this.cmd_flags & CMD_FLAG_MULTI_TRACK)
{
data_length = (2 * eot - sect + 1) * sect_size;
}
else
{
data_length = (eot - sect + 1) * sect_size;
}
if(data_length <= 0)
{
dbg_log("invalid data_length: " + data_length + " sect=" + sect + " eot=" + eot, LOG_FLOPPY);
this.end_read_write(SR0_ABNTERM, SR1_MA, 0);
this.response_data[3] = track;
this.response_data[4] = head;
this.response_data[5] = sect;
return;
}
}
this.eot = eot;
if(DEBUG)
{
dbg_log("Floppy " + this.cmd_table[this.cmd_code].name +
" from: " + h(data_offset) + ", length: " + h(data_length) +
", C/H/S: " + track + "/" + head + "/" + sect + ", ro: " + curr_drive.read_only +
", #S: " + curr_drive.max_sect + ", #H: " + curr_drive.max_head,
LOG_FLOPPY);
}
if(do_write && curr_drive.read_only)
{
this.end_read_write(SR0_ABNTERM | SR0_SEEK, SR1_NW, 0);
this.response_data[3] = track;
this.response_data[4] = head;
this.response_data[5] = sect;
return;
}
if(this.dor & DOR_DMAEN)
{
// start DMA transfer
this.msr &= ~MSR_RQM;
const do_dma = do_write ? this.dma.do_write : this.dma.do_read;
do_dma.call(this.dma,
curr_drive.buffer,
data_offset,
data_length,
FDC_DMA_CHANNEL,
dma_error => {
if(dma_error)
{
dbg_log("DMA floppy error", LOG_FLOPPY);
this.end_read_write(SR0_ABNTERM, 0, 0);
}
else
{
this.seek_next_sect();
this.end_read_write(0, 0, 0);
}
}
);
}
else
{
// start PIO transfer
dbg_assert(false, this.cmd_table[this.cmd_code].name + " in PIO mode not supported!");
}
};
FloppyController.prototype.end_read_write = function(status0, status1, status2)
{
const curr_drive = this.drives[this.curr_drive_no];
this.status0 &= ~(SR0_DS0 | SR0_DS1 | SR0_HEAD);
this.status0 |= this.curr_drive_no;
if(curr_drive.curr_head)
{
this.status0 |= SR0_HEAD;
}
this.status0 |= status0;
this.msr |= MSR_RQM | MSR_DIO;
this.msr &= ~MSR_NDMA;
this.response_data[0] = this.status0;
this.response_data[1] = status1;
this.response_data[2] = status2;
this.response_data[3] = curr_drive.curr_track;
this.response_data[4] = curr_drive.curr_head;
this.response_data[5] = curr_drive.curr_sect;
this.response_data[6] = SECTOR_SIZE_CODE;
// raise interrupt
this.enter_result_phase(7);
this.raise_irq(this.cmd_table[this.cmd_code].name + " command");
};
FloppyController.prototype.seek_next_sect = function()
{
// Seek to next sector
// returns 0 when end of track reached (for DBL_SIDES on head 1). otherwise returns 1
const curr_drive = this.drives[this.curr_drive_no];
// XXX: curr_sect >= max_sect should be an error in fact (TODO: this comment comes from qemu, not sure what to make of it)
let new_track = curr_drive.curr_track;
let new_head = curr_drive.curr_head;
let new_sect = curr_drive.curr_sect;
let ret = 1;
if(new_sect >= curr_drive.max_sect || new_sect === this.eot)
{
new_sect = 1;
if(this.cmd_flags & CMD_FLAG_MULTI_TRACK)
{
if(new_head === 0 && curr_drive.max_head === 2)
{
new_head = 1;
}
else
{
new_head = 0;
new_track++;
this.status0 |= SR0_SEEK;
if(curr_drive.max_head === 1)
{
ret = 0;
}
}
}
else
{
this.status0 |= SR0_SEEK;
new_track++;
ret = 0;
}
}
else
{
new_sect++;
}
curr_drive.seek(new_head, new_track, new_sect);
return ret;
};
FloppyController.prototype.get_state = function()
{
// NOTE: Old-style state snapshots (state indices 0..18) did not include
// the disk image buffer, only a few register states, so a floppy drive
// remained essentially unchangd when a state snapshot was applied.
// The snapshotted registers can be safely ignored when restoring state,
// hence the entire old-style state is now ignored and deprecated.
const state = [];
state[19] = this.sra;
state[20] = this.srb;
state[21] = this.dor;
state[22] = this.tdr;
state[23] = this.msr;
state[24] = this.dsr;
state[25] = this.cmd_phase;
state[26] = this.cmd_code;
state[27] = this.cmd_flags;
state[28] = this.cmd_buffer; // Uint8Array
state[29] = this.cmd_cursor;
state[30] = this.cmd_remaining;
state[31] = this.response_data; // Uint8Array
state[32] = this.response_cursor;
state[33] = this.response_length;
state[34] = this.status0;
state[35] = this.status1;
state[36] = this.curr_drive_no;
state[37] = this.reset_sense_int_count;
state[38] = this.locked;
state[39] = this.step_rate_interval;
state[40] = this.head_load_time;
state[41] = this.fdc_config;
state[42] = this.precomp_trk;
state[43] = this.eot;
state[44] = this.drives[0].get_state();
state[45] = this.drives[1].get_state();
return state;
};
FloppyController.prototype.set_state = function(state)
{
if(typeof state[19] === "undefined")
{
// see comment above in get_state()
return;
}
this.sra = state[19];
this.srb = state[20];
this.dor = state[21];
this.tdr = state[22];
this.msr = state[23];
this.dsr = state[24];
this.cmd_phase = state[25];
this.cmd_code = state[26];
this.cmd_flags = state[27];
this.cmd_buffer.set(state[28]); // Uint8Array
this.cmd_cursor = state[29];
this.cmd_remaining = state[30];
this.response_data.set(state[31]); // Uint8Array
this.response_cursor = state[32];
this.response_length = state[33];
this.status0 = state[34];
this.status1 = state[35];
this.curr_drive_no = state[36];
this.reset_sense_int_count = state[37];
this.locked = state[38];
this.step_rate_interval = state[39];
this.head_load_time = state[40];
this.fdc_config = state[41];
this.precomp_trk = state[42];
this.eot = state[43];
this.drives[0].set_state(state[44]);
this.drives[1].set_state(state[45]);
};
// class FloppyDrive ---------------------------------------------------------
/**
* Floppy disk formats
*
* In many cases, the total sector count (sectors*tracks*heads) of a format
* is enough to uniquely identify it. However, there are some total sector
* collisions between formats of different physical size (drive_type), these
* are highlighed below in the "collides" column.
*
* Matches that are higher up in the table take precedence over later matches.
*
* @see {@link https://github.com/qemu/qemu/blob/e240f6cc25917f3138d9e95e0343ae23b63a3f8c/hw/block/fdc.c#L99}
* @see {@link https://en.wikipedia.org/wiki/List_of_floppy_disk_formats}
*/
const DISK_FORMATS = [
// ttl_sect size collides
// 1.44 MB 3"1/2 floppy disks | | |
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 18, tracks: 80, heads: 2 }, // 2880 1.44 MB 3.5"
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 20, tracks: 80, heads: 2 }, // 3200 1.6 MB 3.5"
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 21, tracks: 80, heads: 2 }, // 3360 1.68 MB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 21, tracks: 82, heads: 2 }, // 3444 1.72 MB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 21, tracks: 83, heads: 2 }, // 3486 1.74 MB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 22, tracks: 80, heads: 2 }, // 3520 1.76 MB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 23, tracks: 80, heads: 2 }, // 3680 1.84 MB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 24, tracks: 80, heads: 2 }, // 3840 1.92 MB
// 2.88 MB 3"1/2 floppy disks
{ drive_type: CMOS_FDD_TYPE_2880, sectors: 36, tracks: 80, heads: 2 }, // 5760 2.88 MB
{ drive_type: CMOS_FDD_TYPE_2880, sectors: 39, tracks: 80, heads: 2 }, // 6240 3.12 MB
{ drive_type: CMOS_FDD_TYPE_2880, sectors: 40, tracks: 80, heads: 2 }, // 6400 3.2 MB
{ drive_type: CMOS_FDD_TYPE_2880, sectors: 44, tracks: 80, heads: 2 }, // 7040 3.52 MB
{ drive_type: CMOS_FDD_TYPE_2880, sectors: 48, tracks: 80, heads: 2 }, // 7680 3.84 MB
// 720 kB 3"1/2 floppy disks
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 8, tracks: 80, heads: 2 }, // 1280 640 kB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 9, tracks: 80, heads: 2 }, // 1440 720 kB 3.5"
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 10, tracks: 80, heads: 2 }, // 1600 800 kB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 10, tracks: 82, heads: 2 }, // 1640 820 kB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 10, tracks: 83, heads: 2 }, // 1660 830 kB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 13, tracks: 80, heads: 2 }, // 2080 1.04 MB
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 14, tracks: 80, heads: 2 }, // 2240 1.12 MB
// 1.2 MB 5"1/4 floppy disks
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 15, tracks: 80, heads: 2 }, // 2400 1.2 MB
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 18, tracks: 80, heads: 2 }, // 2880 1.44 MB 5.25"
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 18, tracks: 82, heads: 2 }, // 2952 1.48 MB
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 18, tracks: 83, heads: 2 }, // 2988 1.49 MB
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 20, tracks: 80, heads: 2 }, // 3200 1.6 MB 5.25"
// 720 kB 5"1/4 floppy disks
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 9, tracks: 80, heads: 2 }, // 1440 720 kB 5.25"
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 11, tracks: 80, heads: 2 }, // 1760 880 kB
// 360 kB 5"1/4 floppy disks
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 9, tracks: 40, heads: 2 }, // 720 360 kB 5.25"
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 9, tracks: 40, heads: 1 }, // 360 180 kB
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 10, tracks: 41, heads: 2 }, // 820 410 kB
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 10, tracks: 42, heads: 2 }, // 840 420 kB
// 320 kB 5"1/4 floppy disks
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 8, tracks: 40, heads: 2 }, // 640 320 kB
{ drive_type: CMOS_FDD_TYPE_1200, sectors: 8, tracks: 40, heads: 1 }, // 320 160 kB
// 360 kB must match 5"1/4 better than 3"1/2...
{ drive_type: CMOS_FDD_TYPE_1440, sectors: 9, tracks: 80, heads: 1 }, // 720 360 kB 3.5"
// types defined in earlier v86 releases (not defined in qemu)
{ drive_type: CMOS_FDD_TYPE_360, sectors: 10, tracks: 40, heads: 1 }, // 400 200 kB
{ drive_type: CMOS_FDD_TYPE_360, sectors: 10, tracks: 40, heads: 2 }, // 800 400 kB
];
/**
* @constructor
*
* @param {string} name
* @param {Object|undefined} fdd_config
* @param {SyncBuffer|Uint8Array|null|undefined} buffer
* @param {number} fallback_drive_type
*/
function FloppyDrive(name, fdd_config, buffer, fallback_drive_type)
{
/** @const */
this.name = name;
// drive state
this.drive_type = CMOS_FDD_TYPE_NO_DRIVE;
// disk state
this.max_track = 0; // disk's max. track, was: FloppyController.number_of_cylinders (qemu: max_track)
this.max_head = 0; // disk's max. head (1 or 2), was: FloppyController.number_of_heads
this.max_sect = 0; // disk's max. sect, was: FloppyController.sectors_per_track (qemu: last_sect)
this.curr_track = 0; // >= 0, was: FloppyController.last_cylinder (qemu: track)
this.curr_head = 0; // 0 or 1, was: FloppyController.last_head (qemu: head)
this.curr_sect = 1; // > 0, was: FloppyController.last_sector (qemu: sect)
this.perpendicular = 0;
this.read_only = false;
this.media_changed = true;
this.buffer = null;
Object.seal(this);
// Drive type this.drive_type is either (in this order):
// - specified in fdd_config.drive_type (if defined),
// - derived from given image buffer (if provided), or
// - specfied in fallback_drive_type.
// If buffer is undefined and fdd_config.drive_type is
// CMOS_FDD_TYPE_NO_DRIVE then the drive will be invisible to the guest.
const cfg_drive_type = fdd_config?.drive_type;
if(cfg_drive_type !== undefined && cfg_drive_type >= 0 && cfg_drive_type <= 5)
{
this.drive_type = cfg_drive_type;
}
this.insert_disk(buffer, !! fdd_config?.read_only);
if(this.drive_type === CMOS_FDD_TYPE_NO_DRIVE && cfg_drive_type === undefined)
{
this.drive_type = fallback_drive_type;
}
dbg_log("floppy drive " + this.name + " ready, drive type: " + this.drive_type, LOG_FLOPPY);
}
/**
* Insert disk image into floppy drive.
*
* @param {SyncBuffer|Uint8Array|null|undefined} buffer
* @param {boolean=} read_only
* @return {boolean} true if the given buffer was accepted
*/
FloppyDrive.prototype.insert_disk = function(buffer, read_only)
{
if(!buffer)
{
return false;
}
if(buffer instanceof Uint8Array)
{
buffer = new SyncBuffer(buffer.buffer);
}
const [new_buffer, disk_format] = this.find_disk_format(buffer, this.drive_type);
if(!new_buffer)
{
dbg_log("WARNING: disk rejected, no suitable disk format found for image of size " +
buffer.byteLength + " bytes", LOG_FLOPPY);
return false;
}
this.max_track = disk_format.tracks;
this.max_head = disk_format.heads;
this.max_sect = disk_format.sectors;
this.read_only = !!read_only;
this.media_changed = true;
this.buffer = new_buffer;
if(this.drive_type === CMOS_FDD_TYPE_NO_DRIVE)
{
// auto-select drive type once during construction
this.drive_type = disk_format.drive_type;
}
if(DEBUG)
{
dbg_log("disk inserted into " + this.name + ": type: " + disk_format.drive_type +
", C/H/S: " + disk_format.tracks + "/" + disk_format.heads + "/" +
disk_format.sectors + ", size: " + new_buffer.byteLength,
LOG_FLOPPY);
}
return true;
};
/**
* Eject disk from this floppy drive.
*/
FloppyDrive.prototype.eject_disk = function()
{
this.max_track = 0;
this.max_head = 0;
this.max_sect = 0;
this.media_changed = true;
this.buffer = null;
};
/**
* Returns this drive's current image buffer or null if no disk is inserted.
* @return {Uint8Array|null}
*/
FloppyDrive.prototype.get_buffer = function()
{
return this.buffer ? this.buffer.buffer : null;
};
/**
* Map structured C/H/S address to linear block address (LBA).
* @param {number} track
* @param {number} head
* @param {number} sect
* @return {number} lba the linear block address
*/
FloppyDrive.prototype.chs2lba = function(track, head, sect)
{
return (track * this.max_head + head) * this.max_sect + sect - 1;
};
/**
* Find best-matching disk format for the given image buffer.
*
* If the given drive_type is CMOS_FDD_TYPE_NO_DRIVE then drive types are
* ignored and the first matching disk format is selected (auto-detect).
*
* If the size of the given buffer does not match any known floppy disk
* format then the smallest format larger than the image buffer is
* selected, and buffer is copied into a new, format-sized buffer with
* trailing zeroes.
*
* Returns [null, null] if the given buffer is larger than any known
* floppy disk format.
*
* @param {SyncBuffer} buffer
* @param {number} drive_type
* @return [{SyncBuffer|null}, {Object|null}] [buffer, disk_format]
*/
FloppyDrive.prototype.find_disk_format = function(buffer, drive_type)
{
const autodetect = drive_type === CMOS_FDD_TYPE_NO_DRIVE;
const buffer_size = buffer.byteLength;
let preferred_match=-1, medium_match=-1, size_match=-1, nearest_match=-1, nearest_size=-1;
for(let i = 0; i < DISK_FORMATS.length; i++)
{
const disk_format = DISK_FORMATS[i];
const disk_size = disk_format.sectors * disk_format.tracks * disk_format.heads * SECTOR_SIZE;
if(buffer_size === disk_size)
{
if(autodetect || disk_format.drive_type === drive_type)
{
// (1) same size and CMOS drive type
preferred_match = i;
break;
}
else if(!autodetect && CMOS_FDD_TYPE_MEDIUM[disk_format.drive_type] === CMOS_FDD_TYPE_MEDIUM[drive_type])
{
// (2) same size and physical medium size (5"1/4 or 3"1/2)
medium_match = (medium_match === -1) ? i : medium_match;
}
else
{
// (3) same size
size_match = (size_match === -1) ? i : size_match;
}
}
else if(buffer_size < disk_size)
{
if(nearest_size === -1 || disk_size < nearest_size)
{
// (4) nearest matching size
nearest_match = i;
nearest_size = disk_size;
}
}
}
if(preferred_match !== -1)
{
return [buffer, DISK_FORMATS[preferred_match]];
}
else if(medium_match !== -1)
{
return [buffer, DISK_FORMATS[medium_match]];
}
else if(size_match !== -1)
{
return [buffer, DISK_FORMATS[size_match]];
}
else if(nearest_match !== -1)
{
const tmp_buffer = new Uint8Array(nearest_size);
tmp_buffer.set(new Uint8Array(buffer.buffer));
return [new SyncBuffer(tmp_buffer.buffer), DISK_FORMATS[nearest_match]];
}
else
{
return [null, null];
}
};
/**
* Seek to a new position, returns:
* 0 if already on right track
* 1 if track changed
* 2 if track is invalid
* 3 if sector is invalid
*
* @param {number} head
* @param {number} track
* @param {number} sect
* @return {number}
*/
FloppyDrive.prototype.seek = function(head, track, sect)
{
if((track > this.max_track) || (head !== 0 && this.max_head === 1))
{
dbg_log("WARNING: attempt to seek to invalid track: head: " + head + ", track: " + track + ", sect: " + sect, LOG_FLOPPY);
return 2;
}
if(sect > this.max_sect)
{
dbg_log("WARNING: attempt to seek beyond last sector: " + sect + " (max: " + this.max_sect + ")", LOG_FLOPPY);
return 3;
}
let result = 0;
const curr_lba = this.chs2lba(this.curr_track, this.curr_head, this.curr_sect);
const new_lba = this.chs2lba(track, head, sect);
if(curr_lba !== new_lba)
{
if(this.curr_track !== track)
{
if(this.buffer)
{
this.media_changed = false;
}
result = 1;
}
this.curr_head = head;
this.curr_track = track;
this.curr_sect = sect;
}
if(!this.buffer)
{
result = 2;
}
return result;
};
FloppyDrive.prototype.get_state = function()
{
const state = [];
state[0] = this.drive_type;
state[1] = this.max_track;
state[2] = this.max_head;
state[3] = this.max_sect;
state[4] = this.curr_track;
state[5] = this.curr_head;
state[6] = this.curr_sect;
state[7] = this.perpendicular;
state[8] = this.read_only;
state[9] = this.media_changed;
state[10] = this.buffer ? this.buffer.get_state() : null; // SyncBuffer
return state;
};
FloppyDrive.prototype.set_state = function(state)
{
this.drive_type = state[0];
this.max_track = state[1];
this.max_head = state[2];
this.max_sect = state[3];
this.curr_track = state[4];
this.curr_head = state[5];
this.curr_sect = state[6];
this.perpendicular = state[7];
this.read_only = state[8];
this.media_changed = state[9];
if(state[10])
{
if(!this.buffer)
{
this.buffer = new SyncBuffer(new ArrayBuffer(0));
}
this.buffer.set_state(state[10]);
}
else
{
this.buffer = null;
}
};