From 7a34ae0da6e55a20a84919b2e798eaf65a50d106 Mon Sep 17 00:00:00 2001
From: Thomas Harte <thomas.harte@gmail.com>
Date: Tue, 20 Sep 2016 16:58:23 -0400
Subject: [PATCH] This is the start of my slog through type 1 commands. I kind
 of need to figure out what I'm doing about drives and PLLs now though.

---
 Components/1770/1770.cpp | 96 +++++++++++++++++++++++++++++++++++++++-
 Components/1770/1770.hpp | 17 ++++++-
 2 files changed, 111 insertions(+), 2 deletions(-)

diff --git a/Components/1770/1770.cpp b/Components/1770/1770.cpp
index e1a800c5f..50545fa29 100644
--- a/Components/1770/1770.cpp
+++ b/Components/1770/1770.cpp
@@ -67,8 +67,102 @@ void WD1770::run_for_cycles(unsigned int number_of_cycles)
 				}
 			continue;
 
+			case State::BeginType1:
+				status_ |= Flag::Busy;
+				status_ &= ~(Flag::DataRequest | Flag::CRCError);
+				set_interrupt_request(false);
+				state_ = State::BeginType1PostSpin;
+				if(command_ & 0x08)
+				{
+					wait_six_index_pulses_.next_state = state_;
+					wait_six_index_pulses_.count = 0;
+					state_ = State::WaitForSixIndexPulses;
+				}
+			continue;
+
+//			case State::WaitForSixIndexPulses:
+//			continue;
+
+			case State::BeginType1PostSpin:
+				switch(command_ >> 4)
+				{
+					case 0:	// restore
+						track_ = 0xff;	// deliberate fallthrough
+					case 1:	// seek
+						data_ = 0x00;
+					break;
+					case 2: case 3: // step
+					break;
+					case 4: case 5: // step in
+						is_step_in_ = true;
+					break;
+					case 6: case 7: // step out
+						is_step_in_ = false;
+					break;
+				}
+
+				if(!(command_ >> 5))
+					state_ = State::TestTrack;
+				else
+					state_ = (command_ & 0x10) ? State::TestDirection : State::TestHead;
+			continue;
+
+			case State::TestTrack:
+				data_shift_register_ = data_;
+				if(track_ == data_shift_register_)
+					state_ = State::TestVerify;
+				else
+				{
+					is_step_in_ = (data_shift_register_ < track_);
+					state_ = State::TestDirection;
+				}
+			continue;
+
+			case State::TestDirection:
+				track_ += is_step_in_ ? -1 : +1;
+				state_ = State::TestHead;
+			continue;
+
+//			case State::TestHead:
+//			break;
+
+			case State::TestVerify:
+				if(command_ & 0x04)
+				{
+					state_ = State::VerifyTrack;
+				}
+				else
+				{
+					set_interrupt_request(true);
+					status_ &= ~Flag::Busy;
+					state_ = State::Waiting;
+				}
+			break;
+
+//     +------+----------+-------------------------+
+//     !	    !	       !	   BITS 	 !
+//     ! TYPE ! COMMAND  !  7  6	5  4  3  2  1  0 !
+//     +------+----------+-------------------------+
+//     !	 1  ! Restore  !  0  0	0  0  h  v r1 r0 !
+//     !	 1  ! Seek     !  0  0	0  1  h  v r1 r0 !
+//     !	 1  ! Step     !  0  0	1  u  h  v r1 r0 !
+//     !	 1  ! Step-in  !  0  1	0  u  h  v r1 r0 !
+//     !	 1  ! Step-out !  0  1	1  u  h  v r1 r0 !
+//     !	 2  ! Rd sectr !  1  0	0  m  h  E  0  0 !
+//     !	 2  ! Wt sectr !  1  0	1  m  h  E  P a0 !
+//     !	 3  ! Rd addr  !  1  1	0  0  h  E  0  0 !
+//     !	 3  ! Rd track !  1  1	1  0  h  E  0  0 !
+//     !	 3  ! Wt track !  1  1	1  1  h  E  P  0 !
+//     !	 4  ! Forc int !  1  1	0  1 i3 i2 i1 i0 !
+//     +------+----------+-------------------------+
+
 			default:
-				printf("Unhandled state %d!", state_);
+			{
+				static bool has_hit_error = false;
+				if(!has_hit_error)
+					printf("Unhandled state %d!\n", state_);
+				has_hit_error = true;
+			}
 			return;
 		}
 	}
diff --git a/Components/1770/1770.hpp b/Components/1770/1770.hpp
index 735199f3d..0bd5e641d 100644
--- a/Components/1770/1770.hpp
+++ b/Components/1770/1770.hpp
@@ -43,15 +43,30 @@ class WD1770 {
 
 		enum class State {
 			Waiting,
-			BeginType1, BeginType2, BeginType3
+			BeginType1, BeginType2, BeginType3,
+			BeginType1PostSpin,
+			WaitForSixIndexPulses,
+			TestTrack, TestDirection, TestHead,
+			TestVerify, VerifyTrack
 		} state_;
 
+		union {
+			struct {
+				int count;
+				State next_state;
+			} wait_six_index_pulses_;
+		};
+
 		uint8_t status_;
 		uint8_t track_;
 		uint8_t sector_;
 		uint8_t data_;
 		uint8_t command_;
 		bool has_command_;
+
+		void set_interrupt_request(bool interrupt_request) {}
+		bool is_step_in_;
+		uint8_t data_shift_register_;
 };
 
 }