2021-12-12 20:40:04 +00:00
|
|
|
/*
|
|
|
|
DingusPPC - The Experimental PowerPC Macintosh emulator
|
2022-02-06 14:23:30 +00:00
|
|
|
Copyright (C) 2018-22 divingkatae and maximum
|
2021-12-12 20:40:04 +00:00
|
|
|
(theweirdo) spatium
|
|
|
|
|
|
|
|
(Contact divingkatae#1017 or powermax#2286 on Discord for more info)
|
|
|
|
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/** @file Sander-Wozniak Machine 3 (SWIM3) emulation. */
|
|
|
|
|
2022-02-07 17:42:35 +00:00
|
|
|
#include <core/timermanager.h>
|
2022-02-07 22:04:13 +00:00
|
|
|
#include <devices/common/hwinterrupt.h>
|
2022-02-06 14:23:30 +00:00
|
|
|
#include <devices/floppy/superdrive.h>
|
|
|
|
#include <devices/floppy/swim3.h>
|
2021-12-12 20:40:04 +00:00
|
|
|
#include <loguru.hpp>
|
2022-02-06 14:23:30 +00:00
|
|
|
#include <machines/machinebase.h>
|
2021-12-12 20:40:04 +00:00
|
|
|
|
|
|
|
#include <cinttypes>
|
|
|
|
#include <memory>
|
|
|
|
|
|
|
|
using namespace Swim3;
|
|
|
|
|
|
|
|
Swim3Ctrl::Swim3Ctrl()
|
|
|
|
{
|
2022-02-07 22:04:13 +00:00
|
|
|
this->name = "SWIM3";
|
|
|
|
this->supported_types = HWCompType::FLOPPY_CTRL;
|
|
|
|
|
2021-12-12 20:40:04 +00:00
|
|
|
this->setup_reg = 0;
|
|
|
|
this->mode_reg = 0;
|
|
|
|
this->int_reg = 0;
|
2022-02-07 17:42:35 +00:00
|
|
|
this->int_flags = 0;
|
2021-12-12 20:40:04 +00:00
|
|
|
this->int_mask = 0;
|
|
|
|
this->xfer_cnt = 0;
|
|
|
|
this->first_sec = 0xFF;
|
|
|
|
|
|
|
|
// Attach virtual Superdrive to the internal drive connector
|
|
|
|
// TODO: make SWIM3/drive wiring user selectable
|
|
|
|
this->int_drive = std::unique_ptr<MacSuperdrive::MacSuperDrive>
|
|
|
|
(new MacSuperdrive::MacSuperDrive());
|
2022-02-06 14:23:30 +00:00
|
|
|
gMachineObj->add_subdevice("Superdrive", this->int_drive.get());
|
2021-12-12 20:40:04 +00:00
|
|
|
}
|
|
|
|
|
2022-02-07 22:04:13 +00:00
|
|
|
int Swim3Ctrl::device_postinit()
|
|
|
|
{
|
|
|
|
this->int_ctrl = dynamic_cast<InterruptCtrl*>(
|
|
|
|
gMachineObj->get_comp_by_type(HWCompType::INT_CTRL));
|
|
|
|
this->irq_id = this->int_ctrl->register_dev_int(IntSrc::SWIM3);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
};
|
|
|
|
|
2021-12-12 20:40:04 +00:00
|
|
|
uint8_t Swim3Ctrl::read(uint8_t reg_offset)
|
|
|
|
{
|
2022-02-07 17:42:35 +00:00
|
|
|
uint8_t status_addr, old_int_flags;
|
2021-12-12 20:40:04 +00:00
|
|
|
|
|
|
|
switch(reg_offset) {
|
|
|
|
case Swim3Reg::Phase:
|
|
|
|
return this->phase_lines;
|
|
|
|
case Swim3Reg::Setup:
|
|
|
|
return this->setup_reg;
|
|
|
|
case Swim3Reg::Handshake_Mode1:
|
|
|
|
if (this->mode_reg & 2) { // internal drive?
|
|
|
|
status_addr = ((this->mode_reg & 0x20) >> 2) | (this->phase_lines & 7);
|
|
|
|
return ((this->int_drive->status(status_addr) & 1) << 2);
|
|
|
|
}
|
2022-02-07 17:42:35 +00:00
|
|
|
return 4;
|
|
|
|
case Swim3Reg::Interrupt_Flags:
|
|
|
|
old_int_flags = this->int_flags;
|
|
|
|
this->int_flags = 0; // read from this register clears all flags
|
|
|
|
update_irq();
|
|
|
|
return old_int_flags;
|
|
|
|
case Swim3Reg::Interrupt_Mask:
|
|
|
|
return this->int_mask;
|
2021-12-12 20:40:04 +00:00
|
|
|
default:
|
|
|
|
LOG_F(INFO, "SWIM3: reading from 0x%X register", reg_offset);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void Swim3Ctrl::write(uint8_t reg_offset, uint8_t value)
|
|
|
|
{
|
2022-02-07 17:42:35 +00:00
|
|
|
uint8_t old_mode_reg;
|
|
|
|
|
2021-12-12 20:40:04 +00:00
|
|
|
switch(reg_offset) {
|
|
|
|
case Swim3Reg::Param_Data:
|
|
|
|
this->pram = value;
|
|
|
|
break;
|
|
|
|
case Swim3Reg::Phase:
|
|
|
|
this->phase_lines = value & 0xF;
|
|
|
|
if (value & 8) {
|
|
|
|
if (this->mode_reg & 2) { // internal drive?
|
|
|
|
this->int_drive->command(
|
|
|
|
((this->mode_reg & 0x20) >> 3) | (this->phase_lines & 3),
|
|
|
|
(value >> 2) & 1
|
|
|
|
);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case Swim3Reg::Setup:
|
|
|
|
this->setup_reg = value;
|
|
|
|
break;
|
|
|
|
case Swim3Reg::Status_Mode0:
|
|
|
|
// ones in value clear the corresponding bits in the mode register
|
2022-02-07 17:42:35 +00:00
|
|
|
if ((this->mode_reg & value) & (SWIM3_GO | SWIM3_GO_STEP)) {
|
|
|
|
if (value & SWIM3_GO_STEP) {
|
|
|
|
stop_stepping();
|
|
|
|
} else {
|
|
|
|
stop_action();
|
|
|
|
}
|
|
|
|
}
|
2021-12-12 20:40:04 +00:00
|
|
|
this->mode_reg &= ~value;
|
|
|
|
break;
|
|
|
|
case Swim3Reg::Handshake_Mode1:
|
|
|
|
// ones in value set the corresponding bits in the mode register
|
2022-02-07 17:42:35 +00:00
|
|
|
if ((this->mode_reg ^ value) & (SWIM3_GO | SWIM3_GO_STEP)) {
|
|
|
|
if (value & SWIM3_GO_STEP) {
|
|
|
|
start_stepping();
|
|
|
|
} else {
|
|
|
|
start_action();
|
|
|
|
}
|
|
|
|
}
|
2021-12-12 20:40:04 +00:00
|
|
|
this->mode_reg |= value;
|
|
|
|
break;
|
2022-02-07 17:42:35 +00:00
|
|
|
case Swim3Reg::Step:
|
|
|
|
this->step_count = value;
|
|
|
|
break;
|
2021-12-12 20:40:04 +00:00
|
|
|
case Swim3Reg::Interrupt_Mask:
|
|
|
|
this->int_mask = value;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
LOG_F(INFO, "SWIM3: writing 0x%X to register 0x%X", value, reg_offset);
|
|
|
|
}
|
|
|
|
}
|
2022-02-07 17:42:35 +00:00
|
|
|
|
|
|
|
void Swim3Ctrl::update_irq()
|
|
|
|
{
|
2022-02-07 22:04:13 +00:00
|
|
|
uint8_t new_irq = !!(this->int_flags & this->int_mask);
|
|
|
|
if (new_irq != this->irq) {
|
|
|
|
this->irq = new_irq;
|
|
|
|
this->int_ctrl->ack_int(this->irq_id, new_irq);
|
|
|
|
}
|
2022-02-07 17:42:35 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void Swim3Ctrl::do_step()
|
|
|
|
{
|
|
|
|
if (this->mode_reg & SWIM3_GO_STEP && this->step_count) { // are we still stepping?
|
|
|
|
// instruct the drive to perform single step in current direction
|
|
|
|
this->int_drive->command(MacSuperdrive::CommandAddr::Do_Step, 0);
|
|
|
|
if (--this->step_count == 0) {
|
|
|
|
if (this->step_timer_id) {
|
|
|
|
this->stop_stepping();
|
|
|
|
}
|
|
|
|
this->int_flags |= INT_STEP_DONE;
|
|
|
|
update_irq();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void Swim3Ctrl::start_stepping()
|
|
|
|
{
|
|
|
|
if (!this->step_count) {
|
|
|
|
LOG_F(WARNING, "SWIM3: step_count is zero while go_step is active!");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((((this->mode_reg & 0x20) >> 3) | (this->phase_lines & 3))
|
|
|
|
!= MacSuperdrive::CommandAddr::Do_Step) {
|
|
|
|
LOG_F(WARNING, "SWIM3: invalid command address on the phase lines!");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
this->mode_reg |= SWIM3_GO_STEP;
|
|
|
|
|
|
|
|
// step count > 1 requires periodic task
|
|
|
|
if (this->step_count > 1) {
|
|
|
|
this->step_timer_id = TimerManager::get_instance()->add_cyclic_timer(
|
|
|
|
USECS_TO_NSECS(80),
|
|
|
|
[this]() {
|
|
|
|
this->do_step();
|
|
|
|
}
|
|
|
|
);
|
|
|
|
}
|
|
|
|
|
|
|
|
// perform the first step immediately
|
|
|
|
do_step();
|
|
|
|
}
|
|
|
|
|
|
|
|
void Swim3Ctrl::stop_stepping()
|
|
|
|
{
|
|
|
|
// cancel stepping task
|
|
|
|
if (this->step_timer_id) {
|
|
|
|
TimerManager::get_instance()->cancel_timer(this->step_timer_id);
|
|
|
|
}
|
|
|
|
this->step_timer_id = 0;
|
|
|
|
this->step_count = 0; // not sure this one is required
|
|
|
|
}
|
|
|
|
|
|
|
|
void Swim3Ctrl::start_action()
|
|
|
|
{
|
|
|
|
LOG_F(INFO, "SWIM3: action started!");
|
|
|
|
}
|
|
|
|
|
|
|
|
void Swim3Ctrl::stop_action()
|
|
|
|
{
|
|
|
|
}
|