From ed2c1939e9bbed8b07ecfbe889a09476fdc03ebb Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Markus=20Fr=C3=B6schle?= <mfro@mubf.de>
Date: Sat, 11 May 2013 09:54:37 +0000
Subject: [PATCH] attached BaS disk i/o routines. EmuTOS does not seem to pick
 them up yet

---
 BaS_gcc/include/xhdi_sd.h        |  7 +------
 BaS_gcc/sources/xhdi_interface.c |  4 ++--
 BaS_gcc/sources/xhdi_sd.c        | 28 +++++++++++++++++++++++++---
 3 files changed, 28 insertions(+), 11 deletions(-)

diff --git a/BaS_gcc/include/xhdi_sd.h b/BaS_gcc/include/xhdi_sd.h
index e93c2d8..1ed1618 100644
--- a/BaS_gcc/include/xhdi_sd.h
+++ b/BaS_gcc/include/xhdi_sd.h
@@ -84,12 +84,7 @@ typedef struct _BPB
 /* a riddle: how do you typedef a function pointer to a function that returns its own type? ;) */
 typedef void* (*xhdi_call_fun)(int xhdi_fun, ...);
 
-struct XHDICALL_args
-{
-	uint16_t opcode;
-};
-
-extern unsigned long xhdi_call(struct XHDICALL_args *stack);
+extern unsigned long xhdi_call(uint16_t *stack);
 
 extern xhdi_call_fun xhdi_sd_install(xhdi_call_fun old_vector) __attribute__((__interrupt__));
 
diff --git a/BaS_gcc/sources/xhdi_interface.c b/BaS_gcc/sources/xhdi_interface.c
index 551feba..10c8362 100644
--- a/BaS_gcc/sources/xhdi_interface.c
+++ b/BaS_gcc/sources/xhdi_interface.c
@@ -27,9 +27,9 @@
 #include "bas_printf.h"
 
 
-unsigned long xhdi_call(struct XHDICALL_args *stack)
+unsigned long xhdi_call(uint16_t *stack)
 {
-	uint16_t opcode = stack->opcode;
+	uint16_t opcode = *stack;
 
 	switch (opcode)
 	{
diff --git a/BaS_gcc/sources/xhdi_sd.c b/BaS_gcc/sources/xhdi_sd.c
index f4220f3..5b411f1 100644
--- a/BaS_gcc/sources/xhdi_sd.c
+++ b/BaS_gcc/sources/xhdi_sd.c
@@ -26,13 +26,14 @@
 #include "xhdi_sd.h"
 #include "bas_printf.h"
 #include "bas_string.h"
+#include "diskio.h"
 
 #define DRIVER_VERSION	0x130
 
 static BPB sd_bpb[4];	/* space for four partitions on SD card */
 
 static xhdi_call_fun old_vector = NULL;
-extern xhdi_call_fun xhdi_vec;
+extern uint32_t xhdi_vec(uint16_t *stack);
 
 __attribute__((__interrupt__)) xhdi_call_fun xhdi_sd_install(xhdi_call_fun ov)
 {
@@ -42,6 +43,7 @@ __attribute__((__interrupt__)) xhdi_call_fun xhdi_sd_install(xhdi_call_fun ov)
 	__asm__ __volatile__ (
 			"move.l		%[xhdi_call],d1\n\t"
 			"move.l		d1,(sp)\n\t"	/* FIXME: dirty overwrite of saved register on stack with return value */
+			"move.l		d1,8(sp)\n\t"
 			: /* output */
 			: [xhdi_call]"g"(xhdi_vec)
 			: "d1","memory");
@@ -105,11 +107,18 @@ uint32_t xhdi_drivemap(void)
 	return map;
 }
 
+#define MY_MAJOR	255
+#define MY_MINOR 	0
+
 uint32_t xhdi_inquire_device(uint16_t bios_device, uint16_t *major, uint16_t *minor,
         uint32_t *start_sector, /* BPB */ void *bpb)
 {
 	xprintf("xhdi_inquire_device() called\r\n");
-	return ERROR;
+	if (major != NULL) *major = MY_MAJOR;
+	if (minor != NULL) *minor = MY_MINOR;
+	if (start_sector != NULL) *start_sector = 0;
+
+	return E_OK;
 }
 
 uint32_t xhdi_inquire_driver(uint16_t bios_device, char *name, char *version,
@@ -142,7 +151,19 @@ uint32_t xhdi_read_write(uint16_t major, uint16_t minor, uint16_t rwflag,
 {
 	xprintf("xhdi_read_write() called: major = %x, minor = %x, rwflag = %x, \r\nrecno = %lx, count = %lx, buf = %p\r\n",
 			major, minor, rwflag, recno, count, buf);
-	return EUNDEV;
+
+	if (major == MY_MAJOR && minor == MY_MINOR)
+	{
+		if (rwflag & 1)	/* write */
+		{
+			disk_write(0, buf, recno, count);
+		}
+		else if (rwflag & 1 == 0) /* read */
+		{
+			disk_read(0, buf, recno, count);
+		}
+	}
+	return E_OK;
 }
 
 uint32_t xhdi_inquire_target2(uint16_t major, uint16_t minor, uint32_t *block_size,
@@ -159,6 +180,7 @@ uint32_t xhdi_inquire_device2(uint16_t bios_device, uint16_t *major, uint16_t *m
 
 	if (bios_device == 'S' - 'A')
 	{
+
 		return E_OK;
 	}
 	return EUNDEV;