1 files changed, 67 insertions, 0 deletions
diff --git a/DskImg.HC b/DskImg.HC
new file mode 100644
index 0000000..077a986
--- /dev/null
+++ b/DskImg.HC
@@ -0,0 +1,67 @@
+#define CYLINDERS 80
+#define SECTORS 18
+#define BASE 0x03F0
+#define IMG_SIZE 1474560
+
+/*
+
+  Make sure IRQ6 is on and
+  pointed to the correct handler!
+
+*/
+
+U8 DskImg()
+{
+  U64 i;
+
+  // Open image file for writing
+  CFile *img = FOpen("Floppy.IMG","w",IMG_SIZE/BLK_SIZE);
+
+  // Initialize the controller
+  FDCReset(BASE);
+  Sleep(100);
+
+  /*
+
+    Loop through each sector,
+    reading each into the buffer,
+    then writing it into the file
+
+  */
+
+  for (i = 0; i < CYLINDERS; i++) {
+    "Track %d\n", i;
+    if (FDCSeek(BASE, i, 0)) {
+      FDCReset(BASE);
+      FClose(img);
+      return 1;
+    }
+    if (FDCSeek(BASE, i, 1)) {
+      FDCReset(BASE);
+      FClose(img);
+      return 1;
+    }
+    FDCReadMulti(BASE, i, 0, 1, 18);
+    FBlkWrite(img, &FDC_DMA, 36 * i, 36);
+  }
+
+  // Return to track 0
+  "Returning to track 0...\n";
+  if (FDCSeek(BASE, 0, 0)) {
+    FDCReset(BASE);
+    FClose(img);
+    return 1;
+  }
+  if (FDCSeek(BASE, 0, 1)) {
+    FDCReset(BASE);
+    FClose(img);
+    return 1;
+  }
+
+  // Close the image file
+  FClose(img);
+
+  return 0;
+}
+
+DskImg;
+\ No newline at end of file