New diodemo sample by Oliver Schmidt

git-svn-id: svn://svn.cc65.org/cc65/trunk@3440 b7a2c559-68d2-44c3-8de9-860c34a00d81

samples/.cvsignore

@@ -1,4 +1,5 @@
 ascii
+diodemo
 fire
 gunzip65
 hello

samples/Makefile

@@ -48,9 +48,22 @@ C1541  	= c1541
 
 
 # --------------------------------------------------------------------------
-# Rules how to make each one of the binaries
+# List of executables. This list could be made target dependent by checking
+# $(SYS).
 
-EXELIST=ascii fire gunzip65 hello mousedemo nachtm plasma sieve tgidemo
+EXELIST	=	ascii 		\
+		diodemo		\
+		fire 		\
+		gunzip65 	\
+		hello 		\
+		mousedemo 	\
+		nachtm 		\
+		plasma 		\
+		sieve 		\
+		tgidemo
+
+# --------------------------------------------------------------------------
+# Rules how to make each one of the binaries
 
 .PHONY:	all
 all:   	$(EXELIST)
@@ -58,6 +71,9 @@ all:   	$(EXELIST)
 ascii: 	       	$(CRT0) ascii.o $(CLIB)
 	@$(LD) -t $(SYS) -m $(basename $@).map -o $@ $^
 
+diodemo:  	       	$(CRT0) diodemo.o $(CLIB)
+	@$(LD) -t $(SYS) -m $(basename $@).map -o $@ $^
+
 fire:  	       	$(CRT0) fire.o $(CLIB)
 	@$(LD) -t $(SYS) -m $(basename $@).map -o $@ $^
 

samples/diodemo.c

@@ -0,0 +1,168 @@
+#include <stddef.h>
+#include <stdlib.h>
+#include <limits.h>
+#include <conio.h>
+#include <ctype.h>
+#include <errno.h>
+#include <dio.h>
+
+
+#define MAX_CHUNKS 10 // Maximum acceptable number of chunks
+
+
+static unsigned char ScreenX;
+static unsigned char ScreenY;
+
+
+static void ClearLine (void)
+{
+    cputc ('\r');
+    cclear (ScreenX);
+}
+
+
+static driveid_t AskForDrive (char* Name)
+{
+    driveid_t Drive = 0;
+    char      Char;
+
+    cprintf ("\r\n%s Drive ID ?", Name);
+
+    do {
+        Char = cgetc ();
+        if (isdigit (Char)) {
+            cputc (Char);
+            Drive = (driveid_t) (Drive * 10 + Char - '0');
+        }
+    } while (Char != CH_ENTER);
+
+    return Drive;
+}
+
+
+static void AskForDisk (char* Name, driveid_t Drive)
+{
+    ClearLine ();
+    cprintf ("\rInsert %s Disk into Drive %d !", Name, Drive);
+
+    cgetc ();
+}
+
+
+static char* AllocBuffer (sectsize_t SectSize, sectnum_t SectCount, sectnum_t* ChunkCount)
+{
+    void*         Buffer = NULL;
+    unsigned long BufferSize;
+    unsigned int  Chunks = 1;
+
+    do {
+        *ChunkCount = (sectnum_t) ((SectCount + Chunks - 1) / Chunks);
+        BufferSize = *ChunkCount * (unsigned long) SectSize;
+        if (BufferSize < UINT_MAX) {
+            Buffer = malloc ((size_t) BufferSize);
+        }
+    } while (Buffer == NULL && ++Chunks <= MAX_CHUNKS);
+
+    return (char*) Buffer;
+}
+
+
+int main (void)
+{
+    driveid_t  SourceId;
+    driveid_t  TargetId;
+    dhandle_t  Source = NULL;
+    dhandle_t  Target = NULL;
+    sectsize_t SectSize;
+    sectnum_t  SectCount;
+    char*      Buffer;
+    sectnum_t  Sector;
+    sectnum_t  ChunkCount;
+    sectnum_t  ChunkOffset = 0;
+
+    clrscr ();
+    screensize (&ScreenX, &ScreenY);
+
+    cputs ("Floppy Disk Copy\r\n");
+    chline (16);
+    cputs ("\r\n");
+
+    SourceId = AskForDrive ("Source");
+    TargetId = AskForDrive ("Target");
+    cputs ("\r\n\r\n");
+
+    do {
+        if (SourceId == TargetId || Source == NULL) {
+            AskForDisk ("Source", SourceId);
+        }
+
+        if (Source == NULL) {
+            Source = dio_open (SourceId);
+            if (Source == NULL) {
+                cprintf ("\r\n\r\nError %d on opening Drive %d\r\n", (int) _oserror, SourceId);
+                return EXIT_FAILURE;
+            }
+
+            SectSize  = dio_query_sectsize (Source);
+            SectCount = dio_query_sectcount (Source);
+
+            Buffer = AllocBuffer (SectSize, SectCount, &ChunkCount);
+            if (Buffer == NULL) {
+                cputs ("\r\n\r\nError on allocating Buffer\r\n");
+                return EXIT_FAILURE;
+            }
+        }
+
+        ClearLine ();
+
+        for (Sector = ChunkOffset; Sector < SectCount && (Sector - ChunkOffset) < ChunkCount; ++Sector) {
+            cprintf ("\rReading Sector %d of %d", Sector + 1, SectCount);
+
+            if (dio_read (Source, Sector, Buffer + (Sector - ChunkOffset) * SectSize) != 0) {
+                cprintf ("\r\n\r\nError %d on reading Drive %d\r\n", (int) _oserror, SourceId);
+                return EXIT_FAILURE;
+            }
+        }
+
+        if (TargetId == SourceId || Target == NULL) {
+            AskForDisk ("Target", TargetId);
+        }
+
+        if (Target == NULL) {
+            Target = dio_open (TargetId);
+            if (Target == NULL) {
+                cprintf ("\r\n\r\nError %d on opening Drive %d\r\n", (int) _oserror, TargetId);
+                return EXIT_FAILURE;
+            }
+
+            if (dio_query_sectsize (Target)  != SectSize ||
+                dio_query_sectcount (Target) != SectCount) {
+                cputs ("\r\n\r\nFormat mismatch between Drives\r\n");
+                return EXIT_FAILURE;
+            }
+        }
+
+        ClearLine ();
+
+        for (Sector = ChunkOffset; Sector < SectCount && (Sector - ChunkOffset) < ChunkCount; ++Sector) {
+            cprintf ("\rWriting Sector %d of %d", Sector + 1, SectCount);
+
+            if (dio_write (Target, Sector, Buffer + (Sector - ChunkOffset) * SectSize) != 0) {
+                cprintf ("\r\n\r\nError %d on opening Drive %d\r\n", (int) _oserror, TargetId);
+                return EXIT_FAILURE;
+            }
+        }
+
+        ChunkOffset += ChunkCount;
+
+    } while (Sector < SectCount);
+
+    ClearLine ();
+    cprintf ("\rSuccessfully copied %d Sectors\r\n", SectCount);
+
+    free (Buffer);
+    dio_close (Source);
+    dio_close (Target);
+
+    return EXIT_SUCCESS;
+}