From 7269966299d9da8a55a64754aaefe3bc9f1c85cd Mon Sep 17 00:00:00 2001
From: ivanli88 <ivanli502@gmail.com>
Date: Fri, 3 Nov 2017 17:12:45 +0800
Subject: [PATCH] add support 40 track

use cammand : dskread 40
---
 src/dskread.c | 159 +++++++++++++++++++++++++++++---------------------
 1 file changed, 93 insertions(+), 66 deletions(-)

diff --git a/src/dskread.c b/src/dskread.c
index f6e06c0..96729a0 100755
--- a/src/dskread.c
+++ b/src/dskread.c
@@ -1,66 +1,93 @@
-#include "a2lib.c"
-
-char online[] = {
-// ORG $301
-    0x20, 0x00, 0xBF, // JSR $BF00 (PRODOS)
-    0xC5,             // DB ON_LINE
-    0x08, 0x03,       // DW PARAMS
-    0x60,             // RTS
-// PARAMS @ $308
-    0x02,             // PARAM_COUNT
-    0x60,             // UNIT_NUM = DRIVE 0, SLOT 6
-    0x00, 0x20        // DATA_BUFFER = $2000
-};        
-char readblk[] = {
-// ORG $301
-    0x20, 0x00, 0xBF, // JSR $BF00 (PRODOS)
-    0x80,             // DB READ_BLOCK
-    0x08, 0x03,       // DW PARAMS
-    0x60,             // RTS
-// PARAMS @ $308
-    0x03,             // PARAM_COUNT
-    0x60,             // UNIT_NUM = DRIVE 0, SLOT 6
-    0x00, 0x20,       // DATA_BUFFER = $2000
-    0x00, 0x00        // BLOCK_NUM
-};
-#define ORG             0x0301
-#define BLOCK_NUM       0x030C
-#define DATA_BUFFER     0x2000
-char dsk[280][512];
-
-int main(int argc, char **argv)
-{
-    FILE *dskfile;
-    char count[2], volname[21];
-    int i, result, fd;
-    int pifd = a2open(argc > 1 ? argv[1] : "127.0.0.1");
-    if (pifd < 0)
-    {
-	perror("Unable to connect to Apple II Pi");
-	exit(EXIT_FAILURE);
-    }
-    a2write(pifd, ORG, sizeof(online),  online);
-    a2call(pifd, ORG, &result);
-    a2read(pifd, DATA_BUFFER, 16, volname);
-    volname[(volname[0] & 0x0F) + 1] = '\0';
-    printf("Volume name:%s\n", volname + 1);
-    strcat(volname + 1, ".PO");
-    a2write(pifd, ORG, sizeof(readblk), readblk);
-    for (i = 0; i < 280; i++)
-    {
-	printf("Reading block #%d\r", i);
-	fflush(stdout);
-	count[0] = i;
-	count[1] = i >> 8;
-	a2write(pifd, BLOCK_NUM, 2, count);
-	a2call(pifd, ORG, &result);
-	a2read(pifd, DATA_BUFFER, 512, dsk[i]);
-    }        
-    a2close(pifd);
-    if ((dskfile = fopen(volname + 1, "wb")))
-    {
-	fwrite(dsk, 1, 280*512, dskfile);
-	fclose(dskfile);
-    }
-    return EXIT_SUCCESS;
-}
+#include "a2lib.c"
+
+char online[] = {
+// ORG $301
+    0x20, 0x00, 0xBF, // JSR $BF00 (PRODOS)
+    0xC5,             // DB ON_LINE
+    0x08, 0x03,       // DW PARAMS
+    0x60,             // RTS
+// PARAMS @ $308
+    0x02,             // PARAM_COUNT
+    0x60,             // UNIT_NUM = DRIVE 0, SLOT 6
+    0x00, 0x20        // DATA_BUFFER = $2000
+};
+char chgmtrk[] = {
+// ORG $301
+	0xAD, 0x8B, 0xC0, 0xAD, 0x8B, 0xC0, 0xAD, 0xE3,
+	0xD6, 0xC9, 0x18, 0xD0, 0x05, 0xA9, 0x40, 0x8D,
+	0xE3, 0xD6, 0xAD, 0x81, 0xC0, 0x60
+};
+char readblk[] = {
+// ORG $301
+    0x20, 0x00, 0xBF, // JSR $BF00 (PRODOS)
+    0x80,             // DB READ_BLOCK
+    0x08, 0x03,       // DW PARAMS
+    0x60,             // RTS
+// PARAMS @ $308
+    0x03,             // PARAM_COUNT
+    0x60,             // UNIT_NUM = DRIVE 0, SLOT 6
+    0x00, 0x20,       // DATA_BUFFER = $2000
+    0x00, 0x00        // BLOCK_NUM
+};
+#define ORG             0x0301
+#define BLOCK_NUM       0x030C
+#define DATA_BUFFER     0x2000
+char dsk[320][512];
+
+int main(int argc, char **argv)
+{
+    FILE *dskfile;
+    char count[2], volname[21];
+    char noname[] = "_NONAME";
+    int i, result, fd, trk, pifd;
+    if (argc > 1)
+    {
+	i = strtol(argv[1],NULL,10);
+	pifd = a2open(i > 41 ? argv[1] : "127.0.0.1");
+	trk = (i < 41 ? i : 35);
+    }
+    else
+    {
+	pifd = a2open("127.0.0.1");
+	trk = 35;
+    }
+    if (pifd < 0)
+    {
+	perror("Unable to connect to Apple II Pi");
+	exit(EXIT_FAILURE);
+    }
+    a2write(pifd, ORG, sizeof(chgmtrk),  chgmtrk);
+    a2call(pifd, ORG, &result);
+
+    a2write(pifd, ORG, sizeof(online),  online);
+    a2call(pifd, ORG, &result);
+    a2read(pifd, DATA_BUFFER, 16, volname);
+    volname[(volname[0] & 0x0F) + 1] = '\0';
+printf("%x\n",volname[0]);
+printf("%x\n",volname);
+    if ( !isprint(volname[1]) )
+	{
+	strcpy(volname, noname);
+	printf("NO VOL NAME OR HEX VOL\n");
+	}
+    printf("Volume name:%s\n", volname +1);
+    strcat(volname + 1, ".PO");
+    a2write(pifd, ORG, sizeof(readblk), readblk);
+    for (i = 0; i < trk*8; i++)
+    {
+	printf("Reading block #%d\r", i);
+	fflush(stdout);
+	count[0] = i;
+	count[1] = i >> 8;
+	a2write(pifd, BLOCK_NUM, 2, count);
+	a2call(pifd, ORG, &result);
+	a2read(pifd, DATA_BUFFER, 512, dsk[i]);
+    }        
+    a2close(pifd);
+    if ((dskfile = fopen(volname + 1, "wb")))
+    {
+	fwrite(dsk, 1, trk*8*512, dskfile);
+	fclose(dskfile);
+    }
+    return EXIT_SUCCESS;
+}