Spaces:
Runtime error
Runtime error
// 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; | |
} | |
}; | |