initial (experimental) version of BaS_gcc SD-card driver for EmuTOS
This commit is contained in:
@@ -72,7 +72,8 @@ CSRCS= \
|
||||
$(SRCDIR)/wait.c \
|
||||
$(SRCDIR)/s19reader.c \
|
||||
$(SRCDIR)/flash.c \
|
||||
$(SRCDIR)/xhdi_sd.c
|
||||
$(SRCDIR)/xhdi_sd.c \
|
||||
$(SRCDIR)/xhdi_interface.c
|
||||
|
||||
ASRCS= \
|
||||
$(SRCDIR)/startcf.S \
|
||||
|
||||
@@ -7,6 +7,48 @@
|
||||
#ifndef _XHDI_SD_H_
|
||||
#define _XHDI_SD_H_
|
||||
|
||||
/* XHDI function numbers */
|
||||
|
||||
#define XHDI_VERSION 0
|
||||
#define XHDI_INQUIRE_TARGET 1
|
||||
#define XHDI_RESERVE 2
|
||||
#define XHDI_LOCK 3
|
||||
#define XHDI_STOP 4
|
||||
#define XHDI_EJECT 5
|
||||
#define XHDI_DRIVEMAP 6
|
||||
#define XHDI_INQUIRE_DEVICE 7
|
||||
#define XHDI_INQUIRE_DRIVER 8
|
||||
#define XHDI_NEW_COOKIE 9
|
||||
#define XHDI_READ_WRITE 10
|
||||
#define XHDI_INQUIRE_TARGET2 11
|
||||
#define XHDI_INQUIRE_DEVICE2 12
|
||||
#define XHDI_DRIVER_SPECIAL 13
|
||||
#define XHDI_GET_CAPACITY 14
|
||||
#define XHDI_MEDIUM_CHANGED 15
|
||||
#define XHDI_MINT_INFO 16
|
||||
#define XHDI_DOS_LIMITS 17
|
||||
#define XHDI_LAST_ACCESS 18
|
||||
|
||||
/* XHDI error codes */
|
||||
|
||||
#define E_OK 0 /* OK */
|
||||
#define ERROR -1 /* unspecified error */
|
||||
#define EDRVNR -2 /* drive not ready */
|
||||
#define EUNDEV -15 /* invalid device/target number */
|
||||
#define EINVFN -32 /* invalid function number */
|
||||
#define EACCDN -36 /* access denied (device currently reserved) */
|
||||
#define EDRIVE -46 /* BIOS device not served by driver */
|
||||
|
||||
/* XHDI device capabilities */
|
||||
|
||||
#define XH_TARGET_STOPPABLE (1 << 0)
|
||||
#define XH_TARGET_REMOVABLE (1 << 1)
|
||||
#define XH_TARGET_LOCKABLE (1 << 2)
|
||||
#define XH_TARGET_EJECTABLE (1 << 3)
|
||||
#define XH_TARGET_LOCKED (1 << 29)
|
||||
#define XH_TARGET_STOPPED (1 << 30)
|
||||
#define XH_TARGET_RESERVED (1 << 31)
|
||||
|
||||
/*
|
||||
* FIXME: dangerous TRAP here!
|
||||
*
|
||||
@@ -27,11 +69,11 @@
|
||||
extern uint32_t xhdi_call(int xhdi_fun, ...);
|
||||
|
||||
extern uint32_t xhdi_version(void); /* XHDI 0 */
|
||||
extern uint32_t xhdi_inquire_target(uint32_t major, uint32_t minor, uint32_t block_size, uint32_t flags,
|
||||
extern uint32_t xhdi_inquire_target(UINT16_T major, UINT16_T minor, uint32_t *block_size, uint32_t *flags,
|
||||
char *product_name); /* XHDI 1 */
|
||||
extern uint32_t xhdi_reserve(UINT16_T major, UINT16_T minor, UINT16_T do_reserve, UINT16_T key); /* XHDI 2 */
|
||||
extern uint32_t xhdi_lock(UINT16_T major, UINT16_T minor, UINT16_T do_lock, UINT16_T key); /* XHDI 3 */
|
||||
extern uint32_t xhdi_stop(UINT16_T major, UINT16_T minor, UINT16_T do_lock, UINT16_T key); /* XHDI 4 */
|
||||
extern uint32_t xhdi_stop(UINT16_T major, UINT16_T minor, UINT16_T do_stop, UINT16_T key); /* XHDI 4 */
|
||||
extern uint32_t xhdi_eject(UINT16_T major, UINT16_T minor, UINT16_T do_eject, UINT16_T key); /* XHDI 5 */
|
||||
extern uint32_t xhdi_drivemap(void); /* XHDI 6 */
|
||||
extern uint32_t xhdi_inquire_device(UINT16_T bios_device, UINT16_T *major, UINT16_T *minor,
|
||||
|
||||
310
BaS_gcc/sources/xhdi_interface.c
Normal file
310
BaS_gcc/sources/xhdi_interface.c
Normal file
@@ -0,0 +1,310 @@
|
||||
/*
|
||||
* xhdi_sd.c
|
||||
*
|
||||
* Created on: 01.05.2013
|
||||
* Author: mfro
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdarg.h>
|
||||
|
||||
#include "xhdi_sd.h"
|
||||
#include "bas_printf.h"
|
||||
|
||||
uint32_t xhdi_call(int xhdi_fun, ...)
|
||||
{
|
||||
va_list arguments;
|
||||
va_start(arguments, xhdi_fun);
|
||||
|
||||
switch (xhdi_fun)
|
||||
{
|
||||
case XHDI_VERSION:
|
||||
return xhdi_version();
|
||||
break;
|
||||
|
||||
case XHDI_INQUIRE_TARGET:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint32_t *block_size;
|
||||
uint32_t *flags;
|
||||
char *product_name;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
block_size = va_arg(arguments, uint32_t *);
|
||||
flags = va_arg(arguments, uint32_t *);
|
||||
product_name = va_arg(arguments, char *);
|
||||
return xhdi_inquire_target(major, minor,
|
||||
block_size, flags, product_name);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_RESERVE:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint16_t do_reserve;
|
||||
uint16_t key;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
do_reserve = va_arg(arguments, unsigned int);
|
||||
key = va_arg(arguments, unsigned int);
|
||||
|
||||
return xhdi_reserve(major, minor, do_reserve, key);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_LOCK:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint16_t do_lock;
|
||||
uint16_t key;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
do_lock = va_arg(arguments, unsigned int);
|
||||
key = va_arg(arguments, unsigned int);
|
||||
|
||||
return xhdi_lock(major, minor, do_lock, key);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_STOP:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint16_t do_stop;
|
||||
uint16_t key;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
do_stop = va_arg(arguments, unsigned int);
|
||||
key = va_arg(arguments, unsigned int);
|
||||
|
||||
return xhdi_stop(major, minor, do_stop, key);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_EJECT:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint16_t do_eject;
|
||||
uint16_t key;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
do_eject = va_arg(arguments, unsigned int);
|
||||
key = va_arg(arguments, unsigned int);
|
||||
|
||||
return xhdi_eject(major, minor, do_eject, key);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_DRIVEMAP:
|
||||
return xhdi_drivemap();
|
||||
break;
|
||||
|
||||
case XHDI_INQUIRE_DEVICE:
|
||||
{
|
||||
uint16_t bios_device;
|
||||
uint16_t *major;
|
||||
uint16_t *minor;
|
||||
uint32_t *start_sector;
|
||||
void *bpb;
|
||||
|
||||
bios_device = va_arg(arguments, unsigned int);
|
||||
major = va_arg(arguments, uint16_t *);
|
||||
minor = va_arg(arguments, uint16_t *);
|
||||
start_sector = va_arg(arguments, uint32_t *);
|
||||
bpb = va_arg(arguments, void *);
|
||||
|
||||
return xhdi_inquire_device(bios_device, major, minor, start_sector, bpb);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_INQUIRE_DRIVER:
|
||||
{
|
||||
uint16_t bios_device;
|
||||
char *name;
|
||||
char *version;
|
||||
char *company;
|
||||
uint16_t *ahdi_version;
|
||||
uint16_t *maxIPL;
|
||||
|
||||
bios_device = va_arg(arguments, unsigned int);
|
||||
name = va_arg(arguments, char *);
|
||||
version = va_arg(arguments, char *);
|
||||
company = va_arg(arguments, char *);
|
||||
ahdi_version = va_arg(arguments, uint16_t *);
|
||||
maxIPL = va_arg(arguments, uint16_t *);
|
||||
|
||||
return xhdi_inquire_driver(bios_device, name, version, company,
|
||||
ahdi_version, maxIPL);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_NEW_COOKIE:
|
||||
{
|
||||
void *new_cookie;
|
||||
|
||||
new_cookie = va_arg(arguments, void *);
|
||||
|
||||
return xhdi_new_cookie(new_cookie);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_READ_WRITE:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint16_t rwflag;
|
||||
uint32_t recno;
|
||||
uint16_t count;
|
||||
void *buf;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
rwflag = va_arg(arguments, unsigned int);
|
||||
recno = va_arg(arguments, uint32_t);
|
||||
count = va_arg(arguments, unsigned int);
|
||||
buf = va_arg(arguments, void *);
|
||||
|
||||
return xhdi_read_write(major, minor, rwflag, recno, count, buf);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_INQUIRE_TARGET2:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint32_t *block_size;
|
||||
uint32_t *device_flags;
|
||||
char *product_name;
|
||||
uint16_t strlen;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
block_size = va_arg(arguments, uint32_t *);
|
||||
device_flags = va_arg(arguments, uint32_t *);
|
||||
product_name = va_arg(arguments, char *);
|
||||
strlen = va_arg(arguments, unsigned int);
|
||||
|
||||
return xhdi_inquire_target2(major, minor, block_size, device_flags,
|
||||
product_name, strlen);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_INQUIRE_DEVICE2:
|
||||
{
|
||||
uint16_t bios_device;
|
||||
uint16_t *major;
|
||||
uint16_t *minor;
|
||||
uint16_t *start_sector;
|
||||
void *bpb;
|
||||
uint32_t *blocks;
|
||||
char *partid;
|
||||
|
||||
bios_device = va_arg(arguments, unsigned int);
|
||||
major = va_arg(arguments, uint16_t *);
|
||||
minor = va_arg(arguments, uint16_t *);
|
||||
start_sector = va_arg(arguments, uint16_t *);
|
||||
bpb = va_arg(arguments, void *);
|
||||
blocks = va_arg(arguments, uint32_t *);
|
||||
partid = va_arg(arguments, char *);
|
||||
|
||||
return xhdi_inquire_device2(bios_device, major, minor, start_sector,
|
||||
bpb, blocks, partid);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_DRIVER_SPECIAL:
|
||||
{
|
||||
uint32_t key1;
|
||||
uint32_t key2;
|
||||
uint16_t subopcode;
|
||||
void *data;
|
||||
|
||||
key1 = va_arg(arguments, uint32_t);
|
||||
key2 = va_arg(arguments, uint32_t);
|
||||
subopcode = va_arg(arguments, unsigned int);
|
||||
data = va_arg(arguments, void *);
|
||||
|
||||
return xhdi_driver_special(key1, key2, subopcode, data);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_GET_CAPACITY:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint32_t *blocks;
|
||||
uint32_t *bs;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
blocks = va_arg(arguments, uint32_t *);
|
||||
bs = va_arg(arguments, uint32_t *);
|
||||
|
||||
return xhdi_get_capacity(major, minor, blocks, bs);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_MEDIUM_CHANGED:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
return xhdi_medium_changed(major, minor);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_MINT_INFO:
|
||||
{
|
||||
uint16_t opcode;
|
||||
void *data;
|
||||
|
||||
opcode = va_arg(arguments, unsigned int);
|
||||
data = va_arg(arguments, void *);
|
||||
|
||||
return xhdi_mint_info(opcode, data);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_DOS_LIMITS:
|
||||
{
|
||||
uint16_t which;
|
||||
uint32_t limit;
|
||||
|
||||
which = va_arg(arguments, unsigned int);
|
||||
limit = va_arg(arguments, uint32_t);
|
||||
|
||||
return xhdi_dos_limits(which, limit);
|
||||
}
|
||||
break;
|
||||
|
||||
case XHDI_LAST_ACCESS:
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint32_t *ms;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
ms = va_arg(arguments, uint32_t *);
|
||||
|
||||
return xhdi_last_access(major, minor, ms);
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
;
|
||||
}
|
||||
xprintf("unknown XHDI function %d\r\n");
|
||||
return EINVFN;
|
||||
}
|
||||
@@ -6,113 +6,117 @@
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdarg.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#include "xhdi_sd.h"
|
||||
#include "bas_printf.h"
|
||||
|
||||
uint32_t xhdi_call(int xhdi_fun, ...)
|
||||
#define DRIVER_VERSION 0x130
|
||||
|
||||
uint32_t xhdi_version(void)
|
||||
{
|
||||
va_list arguments;
|
||||
va_start(arguments, xhdi_fun);
|
||||
return DRIVER_VERSION;
|
||||
}
|
||||
|
||||
switch(xhdi_fun)
|
||||
uint32_t xhdi_inquire_target(uint16_t major, uint16_t minor, uint32_t *block_size, uint32_t *flags,
|
||||
char *product_name)
|
||||
{
|
||||
case 0:
|
||||
return xhdi_version();
|
||||
break;
|
||||
|
||||
case 1:
|
||||
if (block_size != NULL)
|
||||
{
|
||||
uint16_t major;
|
||||
uint16_t minor;
|
||||
uint32_t block_size;
|
||||
uint32_t flags;
|
||||
char *product_name;
|
||||
|
||||
major = va_arg(arguments, unsigned int);
|
||||
minor = va_arg(arguments, unsigned int);
|
||||
block_size = va_arg(arguments, uint32_t);
|
||||
flags = va_arg(arguments, uint32_t);
|
||||
product_name = va_arg(arguments, char *);
|
||||
return xhdi_inquire_target((uint32_t) major, (uint32_t) minor, block_size, flags,
|
||||
product_name);
|
||||
*block_size = 512;
|
||||
}
|
||||
break;
|
||||
*flags = XH_TARGET_REMOVABLE; /* indicate that SD card can be removed */
|
||||
|
||||
#ifdef test
|
||||
case 2:
|
||||
|
||||
return xhdi_reserve();
|
||||
break;
|
||||
|
||||
case 3:
|
||||
return xhdi_lock();
|
||||
break;
|
||||
|
||||
case 4:
|
||||
return xhdi_stop();
|
||||
break;
|
||||
|
||||
case 5:
|
||||
return xhdi_eject();
|
||||
break;
|
||||
|
||||
case 6:
|
||||
return xhdi_drivemap();
|
||||
break;
|
||||
|
||||
case 7:
|
||||
return xhdi_inquire_device();
|
||||
break;
|
||||
|
||||
case 8:
|
||||
return xhdi_inquire_driver();
|
||||
break;
|
||||
|
||||
case 9:
|
||||
return xhdi_new_cookie();
|
||||
break;
|
||||
|
||||
case 10:
|
||||
return xhdi_read_write();
|
||||
break;
|
||||
|
||||
case 11:
|
||||
return xhdi_inquire_target2();
|
||||
break;
|
||||
|
||||
case 12:
|
||||
return xhdi_inquire_device2();
|
||||
break;
|
||||
|
||||
case 13:
|
||||
return xhdi_driver_special();
|
||||
break;
|
||||
|
||||
case 14:
|
||||
return xhdi_get_capacity();
|
||||
break;
|
||||
|
||||
case 15:
|
||||
return xhdi_medium_changed();
|
||||
break;
|
||||
|
||||
case 16:
|
||||
return xhdi_mint_info();
|
||||
break;
|
||||
|
||||
case 17:
|
||||
return xhdi_dos_limits();
|
||||
break;
|
||||
|
||||
case 18:
|
||||
return xhdi_last_access();
|
||||
break;
|
||||
#endif
|
||||
default:
|
||||
;
|
||||
return E_OK;
|
||||
}
|
||||
xprintf("unknown XHDI function %d\r\n");
|
||||
return -32;
|
||||
|
||||
uint32_t xhdi_reserve(UINT16_T major, UINT16_T minor, UINT16_T do_reserve, UINT16_T key)
|
||||
{
|
||||
return ERROR; /* device cannot be reserved */
|
||||
}
|
||||
|
||||
uint32_t xhdi_lock(UINT16_T major, UINT16_T minor, UINT16_T do_lock, UINT16_T key)
|
||||
{
|
||||
return ERROR; /* device cannot be locked */
|
||||
}
|
||||
|
||||
uint32_t xhdi_stop(UINT16_T major, UINT16_T minor, UINT16_T do_stop, UINT16_T key)
|
||||
{
|
||||
return ERROR; /* device cannot be locked */
|
||||
}
|
||||
|
||||
uint32_t xhdi_eject(UINT16_T major, UINT16_T minor, UINT16_T do_eject, UINT16_T key)
|
||||
{
|
||||
return ERROR; /* device cannot be ejected */
|
||||
}
|
||||
|
||||
uint32_t xhdi_drivemap(void)
|
||||
{
|
||||
uint32_t map = 1;
|
||||
|
||||
return map;
|
||||
}
|
||||
|
||||
uint32_t xhdi_inquire_device(UINT16_T bios_device, UINT16_T *major, UINT16_T *minor,
|
||||
uint32_t *start_sector, /* BPB */ void *bpb)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_inquire_driver(UINT16_T bios_device, char *name, char *version,
|
||||
char *company, UINT16_T *ahdi_version, UINT16_T *maxIPL)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_new_cookie(void *newcookie)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_read_write(UINT16_T major, UINT16_T minor, UINT16_T rwflag,
|
||||
uint32_t recno, UINT16_T count, void *buf)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_inquire_target2(UINT16_T major, UINT16_T minor, uint32_t *block_size,
|
||||
uint32_t *device_flags, char *product_name, UINT16_T stringlen)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_inquire_device2(UINT16_T bios_device, UINT16_T *major, UINT16_T *minor,
|
||||
UINT16_T *start_sector, /* BPB */ void *bpb, uint32_t *blocks, char *partid)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_driver_special(uint32_t key1, uint32_t key2, UINT16_T subopcode, void *data)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_get_capacity(UINT16_T major, UINT16_T minor, uint32_t *blocks, uint32_t *bs)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_medium_changed(UINT16_T major, UINT16_T minor)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_mint_info(UINT16_T opcode, void *data)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_dos_limits(UINT16_T which, uint32_t limit)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
uint32_t xhdi_last_access(UINT16_T major, UINT16_T minor, uint32_t *ms)
|
||||
{
|
||||
return ERROR;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user