95 lines
2.9 KiB
C
Executable File
95 lines
2.9 KiB
C
Executable File
/**********
|
|
* Copyright (c) 2004 Greg Parker. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY GREG PARKER ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
**********/
|
|
|
|
#include "pealstub.h"
|
|
#include <PceNativeCall.h>
|
|
|
|
typedef unsigned long uint32_t;
|
|
|
|
// Emulator state for calls back into 68K (set by PealArmStub)
|
|
pcecall PceCall = {0,0,0};
|
|
|
|
// Must match struct PealArgs in m68k/peal.c
|
|
typedef struct {
|
|
void *fn;
|
|
void *arg;
|
|
void *got;
|
|
} PealArgs;
|
|
|
|
static inline void SetR9(void* p)
|
|
{
|
|
asm volatile(
|
|
"mov r9,%0\n\t"
|
|
::"r"(p):"cc");
|
|
}
|
|
|
|
static inline void* GetR9()
|
|
{
|
|
void* p;
|
|
asm volatile(
|
|
"mov %0, r9\n\t"
|
|
: "=&r"(p)::"cc");
|
|
return p;
|
|
}
|
|
|
|
// reads unaligned and byte-swaps
|
|
#define read32(a) \
|
|
( ((((unsigned char *)(a))[0]) << 24) | \
|
|
((((unsigned char *)(a))[1]) << 16) | \
|
|
((((unsigned char *)(a))[2]) << 8) | \
|
|
((((unsigned char *)(a))[3]) << 0) )
|
|
|
|
// interfacearm attribute means PealArmStub can be called from
|
|
// non-interworking ARM code like PceNativeCall if PealArmStub is
|
|
// compiled as Thumb code.
|
|
|
|
uint32_t PealArmStub(const void *emulStateP, PealArgs *args, Call68KFuncType *call68KFuncP)
|
|
{
|
|
pcecall old;
|
|
uint32_t (*fn)(void *);
|
|
void *arg;
|
|
register void *got asm("r10");
|
|
uint32_t result;
|
|
void* SysReg = GetR9();
|
|
|
|
// Unpack args from PealCall() and store GOT in R10
|
|
fn = (uint32_t(*)(void *)) read32(&args->fn);
|
|
arg = (void *) read32(&args->arg);
|
|
got = (void *) read32(&args->got);
|
|
|
|
old = PceCall;
|
|
PceCall.SysReg = SysReg;
|
|
PceCall.State = emulStateP;
|
|
PceCall.Func = call68KFuncP;
|
|
|
|
// Call the function
|
|
result = (*fn)(arg);
|
|
|
|
// Restore old PceNativeCall values
|
|
PceCall = old;
|
|
SetR9(SysReg);
|
|
|
|
return result;
|
|
}
|