mirror of
https://github.com/TomHarte/CLK.git
synced 2024-11-22 12:33:29 +00:00
73 lines
1.7 KiB
C++
73 lines
1.7 KiB
C++
//
|
|
// EXDos.cpp
|
|
// Clock Signal
|
|
//
|
|
// Created by Thomas Harte on 20/06/2021.
|
|
// Copyright © 2021 Thomas Harte. All rights reserved.
|
|
//
|
|
|
|
#include "EXDos.hpp"
|
|
|
|
using namespace Enterprise;
|
|
|
|
EXDos::EXDos() : WD1770(P1770) {
|
|
emplace_drives(4, 8000000, 300, 2);
|
|
set_control_register(0x00);
|
|
}
|
|
|
|
void EXDos::set_disk(std::shared_ptr<Storage::Disk::Disk> disk, size_t drive) {
|
|
get_drive(drive).set_disk(disk);
|
|
disk_did_change_ = true;
|
|
}
|
|
|
|
// Documentation for the control register:
|
|
//
|
|
// Write:
|
|
// b7 in use (???)
|
|
// b6 disk change reset
|
|
// b5 0 = double density, 1 = single density
|
|
// b4 side 1 select
|
|
// b3, b3, b1, b0 select drive 3, 2, 1, 0
|
|
//
|
|
// Read:
|
|
// b7 data request from WD1770
|
|
// b6 disk change
|
|
// b5, b4, b3, b2: not used
|
|
// b1 interrupt request from WD1770
|
|
// b0 drive ready
|
|
|
|
void EXDos::set_control_register(uint8_t control) {
|
|
// printf("Set control: %02x\n", control);
|
|
|
|
if(control & 0x40) disk_did_change_ = false;
|
|
set_is_double_density(!(control & 0x20));
|
|
|
|
// Set side.
|
|
const int head = (control >> 4) & 1;
|
|
for(size_t c = 0; c < 4; c++) {
|
|
get_drive(c).set_head(head);
|
|
}
|
|
|
|
// Select drive.
|
|
set_drive(control & 0xf);
|
|
}
|
|
|
|
uint8_t EXDos::get_control_register() {
|
|
// TODO: how does disk_did_change_ really work? Presumably
|
|
// it latches RDY?
|
|
const uint8_t status =
|
|
(get_data_request_line() ? 0x80 : 0x00) |
|
|
(disk_did_change_ ? 0x40 : 0x00) |
|
|
(get_interrupt_request_line() ? 0x02 : 0x00) |
|
|
(get_drive().get_is_ready() ? 0x01 : 0x00);
|
|
|
|
// printf("Get status: %02x\n", status);
|
|
return status;
|
|
}
|
|
|
|
void EXDos::set_motor_on(bool on) {
|
|
// TODO: this status should transfer if the selected drive changes. But the same goes for
|
|
// writing state, so plenty of work to do in general here.
|
|
get_drive().set_motor_on(on);
|
|
}
|