From b730ac5d5a3b437e52fd06f4f730517de19bb46a Mon Sep 17 00:00:00 2001
From: Thomas Harte <thomas.harte@gmail.com>
Date: Thu, 11 Jul 2019 23:02:47 -0400
Subject: [PATCH] Reintroduces 1-second disable implementation.

---
 Components/DiskII/IWM.cpp | 35 ++++++++++++++---------------------
 Components/DiskII/IWM.hpp |  2 +-
 2 files changed, 15 insertions(+), 22 deletions(-)

diff --git a/Components/DiskII/IWM.cpp b/Components/DiskII/IWM.cpp
index 385d53bdb..1ab0bfefc 100644
--- a/Components/DiskII/IWM.cpp
+++ b/Components/DiskII/IWM.cpp
@@ -82,17 +82,11 @@ uint8_t IWM::read(int address) {
 				(/ENBL1 is low when the first drive's motor is on; /ENBL2 is low when the second drive's motor is on.
 				If the 1-second timer is enabled, motors remain on for one second after being programmatically disabled.)
 			*/
-//			LOGNBR("Reading status (including [" << active_drive_ << "][" << ((state_ & CA2) ? '2' : '-') << ((state_ & CA1) ? '1' : '-') << ((state_ & CA0) ? '0' : '-') << ((state_ & SEL) ? 'S' : '-') << "] ");
-
-			// Determine the SENSE input.
-			uint8_t sense = 1;
-			if(drives_[active_drive_])
-				sense = drives_[active_drive_]->read() ? 1 : 0;
 
 			return uint8_t(
 				(mode_&0x1f) |
 				((state_ & ENABLE) ? 0x20 : 0x00) |
-				(sense << 7)
+				(drives_[active_drive_] ? (drives_[active_drive_]->read() ? 0x80 : 0x00) : 0x80)
 			);
 		} break;
 
@@ -176,12 +170,11 @@ void IWM::access(int address) {
 					if(drives_[active_drive_]) drives_[active_drive_]->set_enabled(true);
 				} else {
 					// If the 1-second delay is enabled, set up a timer for that.
-//					if(!(mode_ & 4)) {
-//						cycles_until_motor_off_ = Cycles(clock_rate_);
-//					} else {
-//						drive_motor_on_ = false;
+					if(!(mode_ & 4)) {
+						cycles_until_disable_ = Cycles(clock_rate_);
+					} else {
 						if(drives_[active_drive_]) drives_[active_drive_]->set_enabled(false);
-//					}
+					}
 				}
 			break;
 
@@ -191,7 +184,7 @@ void IWM::access(int address) {
 					if(drives_[active_drive_]) drives_[active_drive_]->set_enabled(false);
 					active_drive_ = new_drive;
 					if(drives_[active_drive_]) {
-						drives_[active_drive_]->set_enabled(state_ & ENABLE);
+						drives_[active_drive_]->set_enabled(state_ & ENABLE || (cycles_until_disable_ > Cycles(0)));
 						push_drive_state();
 					}
 				}
@@ -223,14 +216,14 @@ void IWM::push_drive_state() {
 
 void IWM::run_for(const Cycles cycles) {
 	// Check for a timeout of the motor-off timer.
-//	if(cycles_until_motor_off_ > Cycles(0)) {
-//		cycles_until_motor_off_ -= cycles;
-//		if(cycles_until_motor_off_ <= Cycles(0)) {
-//			drive_motor_on_ = false;
-//			if(drives_[active_drive_])
-//				drives_[active_drive_]->set_motor_on(false);
-//		}
-//	}
+	if(cycles_until_disable_ > Cycles(0)) {
+		cycles_until_disable_ -= cycles;
+		if(cycles_until_disable_ <= Cycles(0)) {
+			cycles_until_disable_ = Cycles(0);
+			if(drives_[active_drive_])
+				drives_[active_drive_]->set_enabled(false);
+		}
+	}
 
 	// Activity otherwise depends on mode and motor state.
 	int integer_cycles = cycles.as_int();
diff --git a/Components/DiskII/IWM.hpp b/Components/DiskII/IWM.hpp
index c9dee5219..103ed79e5 100644
--- a/Components/DiskII/IWM.hpp
+++ b/Components/DiskII/IWM.hpp
@@ -86,7 +86,7 @@ class IWM:
 
 		void set_component_prefers_clocking(ClockingHint::Source *component, ClockingHint::Preference clocking) override;
 
-		Cycles cycles_until_motor_off_;
+		Cycles cycles_until_disable_;
 		uint8_t write_handshake_ = 0xc0;
 
 		void access(int address);