117 lines
2.6 KiB
C
117 lines
2.6 KiB
C
/*
|
|
* xhdi_test.c
|
|
*
|
|
* Created on: 04.05.2013
|
|
* Author: mfro
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <osbind.h>
|
|
#include "xhdi.h"
|
|
|
|
|
|
static uint32_t *xhdi;
|
|
|
|
static uint32_t cookieptr(void)
|
|
{
|
|
return * (uint32_t *) 0x5a0L;
|
|
}
|
|
|
|
int getcookie(uint32_t cookie, uint32_t *p_value)
|
|
{
|
|
uint32_t *cookiejar = (uint32_t *) Supexec(cookieptr);
|
|
|
|
if (!cookiejar) return 0;
|
|
|
|
do
|
|
{
|
|
if (cookiejar[0] == cookie)
|
|
{
|
|
if (p_value) *p_value = cookiejar[1];
|
|
return 1;
|
|
}
|
|
else
|
|
cookiejar = &(cookiejar[2]);
|
|
} while (cookiejar[-2]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void print_bpb(_BPB *bpb)
|
|
{
|
|
printf("\t\trecsiz = %u\r\n", bpb->recsiz);
|
|
printf("\t\tclsiz = %u\r\n", bpb->clsiz);
|
|
printf("\t\tclsizb = %u\r\n", bpb->clsizb);
|
|
printf("\t\trdlen = %u\r\n", bpb->rdlen);
|
|
printf("\t\tfsiz = %u\r\n", bpb->fsiz);
|
|
printf("\t\tfatrec = %u\r\n", bpb->fatrec);
|
|
printf("\t\tdatrec = %u\r\n", bpb->datrec);
|
|
printf("\t\tnumcl = %u\r\n", bpb->numcl);
|
|
printf("\t\tbflags = %x\r\n", bpb->bflags);
|
|
}
|
|
void xhdi_test(void)
|
|
{
|
|
long drvmap;
|
|
int i;
|
|
|
|
printf("XHDI cookie: %p\r\n\r\n", xhdi);
|
|
|
|
printf("XHGetVersion = %lx\r\n", XHGetVersion(xhdi));
|
|
drvmap = XHDrvMap(xhdi);
|
|
printf("XHDrvmap = %lx\r\n", drvmap);
|
|
|
|
printf("XHInqDev for all XHDI devices\r\n");
|
|
for (i = 0; i < 32; i++)
|
|
{
|
|
uint16_t major = 0;
|
|
uint16_t minor = 0;
|
|
long start_sector = 0L;
|
|
uint32_t ret;
|
|
_BPB *bpb;
|
|
|
|
if ((drvmap >> i) & 1)
|
|
{
|
|
ret = XHInqDev(xhdi, i, &major, &minor, &start_sector, &bpb);
|
|
if (ret == E_OK || ret == EDRVNR)
|
|
{
|
|
long block_size;
|
|
long flags;
|
|
char *product_name;
|
|
|
|
printf("drive %d returned %d:\r\n", i, ret);
|
|
printf("\tmajor = %x, minor = %x, start_sector = %lx, bpb = %p\r\n", major, minor, start_sector, bpb);
|
|
if (bpb != NULL)
|
|
print_bpb(bpb);
|
|
|
|
printf("trying to eject device major = %u, minor = %u. result = %ld\r\n",
|
|
major, minor, XHEject(xhdi, major, minor, 1, 1));
|
|
printf("trying to lock device major = %u, minor = %u. result = %ld\r\n",
|
|
major, minor, XHLock(xhdi, major, minor, 1, 1));
|
|
|
|
printf("inquire target major = %u, minor = %u. result = %ld\r\n", major, minor,
|
|
XHInqTarget(xhdi, major, minor, &block_size, &flags, &product_name));
|
|
printf("block_size = %ld, flags = %ld, product_name = \"%s\"", block_size, flags, product_name);
|
|
|
|
}
|
|
}
|
|
bpb = NULL;
|
|
}
|
|
}
|
|
int main(int argc, char *argv[])
|
|
{
|
|
(void) Cconws("\033EGCC XHDI Test Program\r\n=====================\r\n\r\n");
|
|
|
|
if (getcookie('XHDI', (uint32_t *) &xhdi))
|
|
{
|
|
Supexec(xhdi_test);
|
|
}
|
|
else
|
|
(void) Cconws("no XHDI cookie found.\r\n");
|
|
|
|
(void) Cconws("\r\n<press any key to return to desktop>\r\n");
|
|
(void) Cconin();
|
|
|
|
return 0;
|
|
}
|