80 lines
1.4 KiB
C
80 lines
1.4 KiB
C
/*
|
|
* emusd.c
|
|
*
|
|
* The driver actually resides within BaS_gcc. All we need to do within the AUTO-folder program is to find the driver
|
|
* entry point and put its address into the XHDI cookie
|
|
*
|
|
* Created on: 01.05.2013
|
|
* Author: mfro
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <stddef.h>
|
|
#include <stdio.h>
|
|
#include <osbind.h>
|
|
|
|
#define XHDIMAGIC 0x27011992L
|
|
|
|
typedef uint32_t (*cookie_fun)(uint16_t opcode,...);
|
|
|
|
static cookie_fun old_vector = NULL;
|
|
|
|
static cookie_fun get_fun_ptr(void)
|
|
{
|
|
static cookie_fun XHDI = NULL;
|
|
static int have_it = 0;
|
|
|
|
if (!have_it)
|
|
{
|
|
uint32_t *magic_test;
|
|
|
|
getcookie ('XHDI', (uint32_t *) &XHDI);
|
|
have_it = 1;
|
|
|
|
/* check magic */
|
|
|
|
magic_test = (uint32_t *)XHDI;
|
|
if (magic_test && (magic_test[-1] != XHDIMAGIC))
|
|
XHDI = NULL;
|
|
}
|
|
|
|
return XHDI;
|
|
}
|
|
|
|
__extension__ cookie_fun bas_sd_vector(cookie_fun old_vector)
|
|
{
|
|
register long retvalue __asm__("d0");
|
|
|
|
__asm__ __volatile(
|
|
"move.l %1,-(sp)\n\t"
|
|
"trap #0\n\t"
|
|
"addq.l #4,sp\n\t"
|
|
: "=r"(retvalue)
|
|
: "g"(old_vector)
|
|
:
|
|
);
|
|
retvalue;
|
|
}
|
|
|
|
int main(int argc, char *argv[])
|
|
{
|
|
uint32_t value;
|
|
cookie_fun bas_vector;
|
|
|
|
if (getcookie('XHDI', &value))
|
|
{
|
|
if ((old_vector = get_fun_ptr()))
|
|
{
|
|
printf("old XHDI vector (%p) found and saved\r\n", old_vector);
|
|
}
|
|
}
|
|
|
|
bas_vector = bas_sd_vector(old_vector);
|
|
printf("got vector from BaS: %p\r\n", bas_vector);
|
|
setcookie('XHDI', (uint32_t) bas_vector);
|
|
|
|
printf("vector to BaS driver set\r\n");
|
|
|
|
return 0;
|
|
}
|