111bfab3b5
This is needed by OS/2 and Windows NT and some programs like VirtualPC. This patch has been tested using OS/2 bootloader (thanks to Tero Kaarlela). (Jocelyn Mayer) git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@1379 c046a42c-6fe2-441c-8c8c-71466251a162
372 lines
9.5 KiB
C
372 lines
9.5 KiB
C
/* External helpers */
|
|
void glue(do_lsw, MEMSUFFIX) (int dst);
|
|
void glue(do_stsw, MEMSUFFIX) (int src);
|
|
|
|
static inline uint16_t glue(ld16r, MEMSUFFIX) (target_ulong EA)
|
|
{
|
|
uint16_t tmp = glue(lduw, MEMSUFFIX)(EA);
|
|
return ((tmp & 0xFF00) >> 8) | ((tmp & 0x00FF) << 8);
|
|
}
|
|
|
|
static inline int32_t glue(ld16rs, MEMSUFFIX) (target_ulong EA)
|
|
{
|
|
int16_t tmp = glue(lduw, MEMSUFFIX)(EA);
|
|
return ((tmp & 0xFF00) >> 8) | ((tmp & 0x00FF) << 8);
|
|
}
|
|
|
|
static inline uint32_t glue(ld32r, MEMSUFFIX) (target_ulong EA)
|
|
{
|
|
uint32_t tmp = glue(ldl, MEMSUFFIX)(EA);
|
|
return ((tmp & 0xFF000000) >> 24) | ((tmp & 0x00FF0000) >> 8) |
|
|
((tmp & 0x0000FF00) << 8) | ((tmp & 0x000000FF) << 24);
|
|
}
|
|
|
|
static inline void glue(st16r, MEMSUFFIX) (target_ulong EA, uint16_t data)
|
|
{
|
|
uint16_t tmp = ((data & 0xFF00) >> 8) | ((data & 0x00FF) << 8);
|
|
glue(stw, MEMSUFFIX)(EA, tmp);
|
|
}
|
|
|
|
static inline void glue(st32r, MEMSUFFIX) (target_ulong EA, uint32_t data)
|
|
{
|
|
uint32_t tmp = ((data & 0xFF000000) >> 24) | ((data & 0x00FF0000) >> 8) |
|
|
((data & 0x0000FF00) << 8) | ((data & 0x000000FF) << 24);
|
|
glue(stl, MEMSUFFIX)(EA, tmp);
|
|
}
|
|
|
|
/*** Integer load ***/
|
|
#define PPC_LD_OP(name, op) \
|
|
PPC_OP(glue(glue(l, name), MEMSUFFIX)) \
|
|
{ \
|
|
T1 = glue(op, MEMSUFFIX)(T0); \
|
|
RETURN(); \
|
|
}
|
|
|
|
#define PPC_ST_OP(name, op) \
|
|
PPC_OP(glue(glue(st, name), MEMSUFFIX)) \
|
|
{ \
|
|
glue(op, MEMSUFFIX)(T0, T1); \
|
|
RETURN(); \
|
|
}
|
|
|
|
PPC_LD_OP(bz, ldub);
|
|
PPC_LD_OP(ha, ldsw);
|
|
PPC_LD_OP(hz, lduw);
|
|
PPC_LD_OP(wz, ldl);
|
|
|
|
PPC_LD_OP(ha_le, ld16rs);
|
|
PPC_LD_OP(hz_le, ld16r);
|
|
PPC_LD_OP(wz_le, ld32r);
|
|
|
|
/*** Integer store ***/
|
|
PPC_ST_OP(b, stb);
|
|
PPC_ST_OP(h, stw);
|
|
PPC_ST_OP(w, stl);
|
|
|
|
PPC_ST_OP(h_le, st16r);
|
|
PPC_ST_OP(w_le, st32r);
|
|
|
|
/*** Integer load and store with byte reverse ***/
|
|
PPC_LD_OP(hbr, ld16r);
|
|
PPC_LD_OP(wbr, ld32r);
|
|
PPC_ST_OP(hbr, st16r);
|
|
PPC_ST_OP(wbr, st32r);
|
|
|
|
PPC_LD_OP(hbr_le, lduw);
|
|
PPC_LD_OP(wbr_le, ldl);
|
|
PPC_ST_OP(hbr_le, stw);
|
|
PPC_ST_OP(wbr_le, stl);
|
|
|
|
/*** Integer load and store multiple ***/
|
|
PPC_OP(glue(lmw, MEMSUFFIX))
|
|
{
|
|
int dst = PARAM(1);
|
|
|
|
for (; dst < 32; dst++, T0 += 4) {
|
|
ugpr(dst) = glue(ldl, MEMSUFFIX)(T0);
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(stmw, MEMSUFFIX))
|
|
{
|
|
int src = PARAM(1);
|
|
|
|
for (; src < 32; src++, T0 += 4) {
|
|
glue(stl, MEMSUFFIX)(T0, ugpr(src));
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(lmw_le, MEMSUFFIX))
|
|
{
|
|
int dst = PARAM(1);
|
|
|
|
for (; dst < 32; dst++, T0 += 4) {
|
|
ugpr(dst) = glue(ld32r, MEMSUFFIX)(T0);
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(stmw_le, MEMSUFFIX))
|
|
{
|
|
int src = PARAM(1);
|
|
|
|
for (; src < 32; src++, T0 += 4) {
|
|
glue(st32r, MEMSUFFIX)(T0, ugpr(src));
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
/*** Integer load and store strings ***/
|
|
PPC_OP(glue(lswi, MEMSUFFIX))
|
|
{
|
|
glue(do_lsw, MEMSUFFIX)(PARAM(1));
|
|
RETURN();
|
|
}
|
|
|
|
void glue(do_lsw_le, MEMSUFFIX) (int dst);
|
|
PPC_OP(glue(lswi_le, MEMSUFFIX))
|
|
{
|
|
glue(do_lsw_le, MEMSUFFIX)(PARAM(1));
|
|
RETURN();
|
|
}
|
|
|
|
/* PPC32 specification says we must generate an exception if
|
|
* rA is in the range of registers to be loaded.
|
|
* In an other hand, IBM says this is valid, but rA won't be loaded.
|
|
* For now, I'll follow the spec...
|
|
*/
|
|
PPC_OP(glue(lswx, MEMSUFFIX))
|
|
{
|
|
if (T1 > 0) {
|
|
if ((PARAM(1) < PARAM(2) && (PARAM(1) + T1) > PARAM(2)) ||
|
|
(PARAM(1) < PARAM(3) && (PARAM(1) + T1) > PARAM(3))) {
|
|
do_raise_exception_err(EXCP_PROGRAM, EXCP_INVAL | EXCP_INVAL_LSWX);
|
|
} else {
|
|
glue(do_lsw, MEMSUFFIX)(PARAM(1));
|
|
}
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(lswx_le, MEMSUFFIX))
|
|
{
|
|
if (T1 > 0) {
|
|
if ((PARAM(1) < PARAM(2) && (PARAM(1) + T1) > PARAM(2)) ||
|
|
(PARAM(1) < PARAM(3) && (PARAM(1) + T1) > PARAM(3))) {
|
|
do_raise_exception_err(EXCP_PROGRAM, EXCP_INVAL | EXCP_INVAL_LSWX);
|
|
} else {
|
|
glue(do_lsw_le, MEMSUFFIX)(PARAM(1));
|
|
}
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(stsw, MEMSUFFIX))
|
|
{
|
|
glue(do_stsw, MEMSUFFIX)(PARAM(1));
|
|
RETURN();
|
|
}
|
|
|
|
void glue(do_stsw_le, MEMSUFFIX) (int src);
|
|
PPC_OP(glue(stsw_le, MEMSUFFIX))
|
|
{
|
|
glue(do_stsw_le, MEMSUFFIX)(PARAM(1));
|
|
RETURN();
|
|
}
|
|
|
|
/*** Floating-point store ***/
|
|
#define PPC_STF_OP(name, op) \
|
|
PPC_OP(glue(glue(st, name), MEMSUFFIX)) \
|
|
{ \
|
|
glue(op, MEMSUFFIX)(T0, FT1); \
|
|
RETURN(); \
|
|
}
|
|
|
|
PPC_STF_OP(fd, stfq);
|
|
PPC_STF_OP(fs, stfl);
|
|
|
|
static inline void glue(stfqr, MEMSUFFIX) (target_ulong EA, double d)
|
|
{
|
|
union {
|
|
double d;
|
|
uint64_t u;
|
|
} u;
|
|
|
|
u.d = d;
|
|
u.u = ((u.u & 0xFF00000000000000ULL) >> 56) |
|
|
((u.u & 0x00FF000000000000ULL) >> 40) |
|
|
((u.u & 0x0000FF0000000000ULL) >> 24) |
|
|
((u.u & 0x000000FF00000000ULL) >> 8) |
|
|
((u.u & 0x00000000FF000000ULL) << 8) |
|
|
((u.u & 0x0000000000FF0000ULL) << 24) |
|
|
((u.u & 0x000000000000FF00ULL) << 40) |
|
|
((u.u & 0x00000000000000FFULL) << 56);
|
|
glue(stfq, MEMSUFFIX)(EA, u.d);
|
|
}
|
|
|
|
static inline void glue(stflr, MEMSUFFIX) (target_ulong EA, float f)
|
|
{
|
|
union {
|
|
float f;
|
|
uint32_t u;
|
|
} u;
|
|
|
|
u.f = f;
|
|
u.u = ((u.u & 0xFF000000UL) >> 24) |
|
|
((u.u & 0x00FF0000ULL) >> 8) |
|
|
((u.u & 0x0000FF00UL) << 8) |
|
|
((u.u & 0x000000FFULL) << 24);
|
|
glue(stfl, MEMSUFFIX)(EA, u.f);
|
|
}
|
|
|
|
PPC_STF_OP(fd_le, stfqr);
|
|
PPC_STF_OP(fs_le, stflr);
|
|
|
|
/*** Floating-point load ***/
|
|
#define PPC_LDF_OP(name, op) \
|
|
PPC_OP(glue(glue(l, name), MEMSUFFIX)) \
|
|
{ \
|
|
FT1 = glue(op, MEMSUFFIX)(T0); \
|
|
RETURN(); \
|
|
}
|
|
|
|
PPC_LDF_OP(fd, ldfq);
|
|
PPC_LDF_OP(fs, ldfl);
|
|
|
|
static inline double glue(ldfqr, MEMSUFFIX) (target_ulong EA)
|
|
{
|
|
union {
|
|
double d;
|
|
uint64_t u;
|
|
} u;
|
|
|
|
u.d = glue(ldfq, MEMSUFFIX)(EA);
|
|
u.u = ((u.u & 0xFF00000000000000ULL) >> 56) |
|
|
((u.u & 0x00FF000000000000ULL) >> 40) |
|
|
((u.u & 0x0000FF0000000000ULL) >> 24) |
|
|
((u.u & 0x000000FF00000000ULL) >> 8) |
|
|
((u.u & 0x00000000FF000000ULL) << 8) |
|
|
((u.u & 0x0000000000FF0000ULL) << 24) |
|
|
((u.u & 0x000000000000FF00ULL) << 40) |
|
|
((u.u & 0x00000000000000FFULL) << 56);
|
|
|
|
return u.d;
|
|
}
|
|
|
|
static inline float glue(ldflr, MEMSUFFIX) (target_ulong EA)
|
|
{
|
|
union {
|
|
float f;
|
|
uint32_t u;
|
|
} u;
|
|
|
|
u.f = glue(ldfl, MEMSUFFIX)(EA);
|
|
u.u = ((u.u & 0xFF000000UL) >> 24) |
|
|
((u.u & 0x00FF0000ULL) >> 8) |
|
|
((u.u & 0x0000FF00UL) << 8) |
|
|
((u.u & 0x000000FFULL) << 24);
|
|
|
|
return u.f;
|
|
}
|
|
|
|
PPC_LDF_OP(fd_le, ldfqr);
|
|
PPC_LDF_OP(fs_le, ldflr);
|
|
|
|
/* Load and set reservation */
|
|
PPC_OP(glue(lwarx, MEMSUFFIX))
|
|
{
|
|
if (T0 & 0x03) {
|
|
do_raise_exception(EXCP_ALIGN);
|
|
} else {
|
|
T1 = glue(ldl, MEMSUFFIX)(T0);
|
|
regs->reserve = T0;
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(lwarx_le, MEMSUFFIX))
|
|
{
|
|
if (T0 & 0x03) {
|
|
do_raise_exception(EXCP_ALIGN);
|
|
} else {
|
|
T1 = glue(ld32r, MEMSUFFIX)(T0);
|
|
regs->reserve = T0;
|
|
}
|
|
RETURN();
|
|
}
|
|
|
|
/* Store with reservation */
|
|
PPC_OP(glue(stwcx, MEMSUFFIX))
|
|
{
|
|
if (T0 & 0x03) {
|
|
do_raise_exception(EXCP_ALIGN);
|
|
} else {
|
|
if (regs->reserve != T0) {
|
|
env->crf[0] = xer_ov;
|
|
} else {
|
|
glue(stl, MEMSUFFIX)(T0, T1);
|
|
env->crf[0] = xer_ov | 0x02;
|
|
}
|
|
}
|
|
regs->reserve = 0;
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(stwcx_le, MEMSUFFIX))
|
|
{
|
|
if (T0 & 0x03) {
|
|
do_raise_exception(EXCP_ALIGN);
|
|
} else {
|
|
if (regs->reserve != T0) {
|
|
env->crf[0] = xer_ov;
|
|
} else {
|
|
glue(st32r, MEMSUFFIX)(T0, T1);
|
|
env->crf[0] = xer_ov | 0x02;
|
|
}
|
|
}
|
|
regs->reserve = 0;
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(dcbz, MEMSUFFIX))
|
|
{
|
|
glue(stl, MEMSUFFIX)(T0 + 0x00, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x04, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x08, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x0C, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x10, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x14, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x18, 0);
|
|
glue(stl, MEMSUFFIX)(T0 + 0x1C, 0);
|
|
RETURN();
|
|
}
|
|
|
|
/* External access */
|
|
PPC_OP(glue(eciwx, MEMSUFFIX))
|
|
{
|
|
T1 = glue(ldl, MEMSUFFIX)(T0);
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(ecowx, MEMSUFFIX))
|
|
{
|
|
glue(stl, MEMSUFFIX)(T0, T1);
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(eciwx_le, MEMSUFFIX))
|
|
{
|
|
T1 = glue(ld32r, MEMSUFFIX)(T0);
|
|
RETURN();
|
|
}
|
|
|
|
PPC_OP(glue(ecowx_le, MEMSUFFIX))
|
|
{
|
|
glue(st32r, MEMSUFFIX)(T0, T1);
|
|
RETURN();
|
|
}
|
|
|
|
#undef MEMSUFFIX
|