Add better floppy MODE page support

diff --git a/CHANGELOG b/CHANGELOG
index 81ed2cc587aeaa05b5f05d2ebb86d6b60429a8d4..aa3cd6acb4cd1ea9dae7c4f1970f93ec75972095 100644 (file)
--- a/CHANGELOG
+++ b/CHANGELOG
@@ -1,3 +1,7 @@
+2019XXXX               4.9.X
+       - Improve XEBEC controller support
+       - Add Flexible Disk Drive Geometry SCSI MODE page
+
 20180926               4.8.1
        - Fix bug when writing with multiple SCSI devices on the chain
 

diff --git a/software/SCSI2SD/src/mode.c b/software/SCSI2SD/src/mode.c
index f9d529a52af77f13580af1d022d944e31d4fe2ae..95d00e9ab587a5fa5c088cfdcf72a5c9b96f7430 100755 (executable)
--- a/software/SCSI2SD/src/mode.c
+++ b/software/SCSI2SD/src/mode.c
@@ -120,6 +120,35 @@ static const uint8 RigidDiskDriveGeometry[] =
 0x00, 0x00 // Reserved\r
 };\r
 \r
+static const uint8 FlexibleDiskDriveGeometry[] =\r
+{\r
+0x05, // Page code\r
+0x1E, // Page length\r
+0x01, 0xF4, // Transfer Rate (500kbits)\r
+0x01, // heads\r
+18, // sectors per track\r
+0x20,0x00, // bytes per sector\r
+0x00, 80, // Cylinders\r
+0x00, 0x80, // Write-precomp\r
+0x00, 0x80, // reduced current,\r
+0x00, 0x00, // Drive step rate\r
+0x00, // pulse width\r
+0x00, 0x00, // Head settle delay\r
+0x00, // motor on delay\r
+0x00,  // motor off delay\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00,\r
+0x00\r
+};\r
+\r
 static const uint8 RigidDiskDriveGeometry_SCSI1[] =\r
 {\r
 0x04, // Page code\r
@@ -439,6 +468,13 @@ static void doModeSense(
                }\r
        }\r
 \r
+       if (pageCode == 0x05 || pageCode == 0x3F)\r
+       {\r
+               pageFound = 1;\r
+               pageIn(pc, idx, FlexibleDiskDriveGeometry, sizeof(FlexibleDiskDriveGeometry));\r
+               idx += sizeof(FlexibleDiskDriveGeometry);\r
+       }\r
+\r
        // DON'T output the following pages for SCSI1 hosts. They get upset when\r
        // we have more data to send than the allocation length provided.\r
        // (ie. Try not to output any more pages below this comment)\r