mirror of
https://gitlab.os-k.eu/os-k-team/kvisc.git
synced 2023-08-25 14:05:46 +02:00
145 lines
6.9 KiB
C
145 lines
6.9 KiB
C
// The OS/K Team licenses this file to you under the MIT license.
|
|
// See the LICENSE file in the project root for more information.
|
|
|
|
#include <pc/arch.h>
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define DECV(v, p) \
|
|
ulong v; \
|
|
GETV(v, p)
|
|
|
|
#define GETV(v, p) \
|
|
if (ACC_FMT_IS_MEM(p->type)) \
|
|
v = readmem(ctx, p->addr, p->mlen); \
|
|
else v = p->val
|
|
|
|
#define DECVZX(v, p) \
|
|
ulong v; \
|
|
GETVZX(v, p)
|
|
|
|
#define GETVZX(v, p) \
|
|
if (ACC_FMT_IS_MEM(p->type)) \
|
|
v = readmemzx(ctx, p->addr, p->mlen); \
|
|
else v = p->val
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define IMPL_START_0(name) \
|
|
uint i_##name(ctx_t *ctx, acc_t *p1, acc_t *p2, acc_t *p3, \
|
|
ulong *r1, ulong *r2, ulong *r3) \
|
|
{
|
|
|
|
#define IMPL_START_1(name) \
|
|
IMPL_START_0(name) \
|
|
DECV(v1, p1);
|
|
|
|
#define IMPL_START_X_NOIN(name) \
|
|
IMPL_START_0(name) \
|
|
ulong v1, v2, v3; \
|
|
(void)v1; (void)v2; (void)v3;
|
|
|
|
#define IMPL_START_2(name) \
|
|
IMPL_START_1(name) \
|
|
DECV(v2, p2);
|
|
|
|
#define IMPL_START_2_ONLY(name) \
|
|
IMPL_START_0(name) \
|
|
ulong v1; \
|
|
DECV(v2, p2);
|
|
|
|
#define IMPL_START_3(name) \
|
|
IMPL_START_2(name) \
|
|
DECV(v3, p3);
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define IMPL_END \
|
|
return 0; \
|
|
}
|
|
|
|
#define IMPL_OUT \
|
|
*r1 = v1; \
|
|
return 1; \
|
|
}
|
|
|
|
#define IMPL_OUT_ZSF \
|
|
SET_ZSF(v1); \
|
|
IMPL_OUT
|
|
|
|
#define IMPL_OUT_2 \
|
|
*r1 = v1; \
|
|
*r2 = v2; \
|
|
return 2; \
|
|
}
|
|
|
|
#define IMPL_OUT_3 \
|
|
*r1 = v1; \
|
|
*r2 = v2; \
|
|
*r3 = v3; \
|
|
return 3; \
|
|
}
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define INTO() \
|
|
if (R(RFX) & OF) _except(ctx, E_OVF, "Overflow");
|
|
|
|
#define PARITY(v) __builtin_parity(v)
|
|
|
|
#define SET_ZF(v) \
|
|
R(RFX) = ((v) == 0 ? (R(RFX)|ZF) : (R(RFX)&~ZF))
|
|
|
|
#define SET_SF(v) \
|
|
R(RFX) = ((long)(v) < 0 ? (R(RFX)|SF) : (R(RFX)&~SF))
|
|
|
|
#define SET_PF(v) \
|
|
R(RFX) = (PARITY(v) == 1 ? (R(RFX)|PF) : (R(RFX)&~PF))
|
|
|
|
#define SET_ZSF(v) \
|
|
SET_ZF(v); \
|
|
SET_SF(v)
|
|
|
|
#define SET_ZSPF(v) \
|
|
SET_ZF(v); \
|
|
SET_SF(v); \
|
|
SET_PF(v)
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define COMPARE_ADD(v1, v2) \
|
|
ulong _u1 = (ulong)v1, _u2 = (ulong)v2, _u3 = (_u1 + _u2); \
|
|
\
|
|
if (_u1 + _u2 < _u2) R(RFX) |= CF; \
|
|
else R(RFX) &= ~CF; \
|
|
\
|
|
if (((_u1 ^ _u3) & (_u2 ^ _u3)) >> 63) \
|
|
R(RFX) |= OF; \
|
|
else R(RFX) &= ~OF; \
|
|
\
|
|
SET_ZSF(_u3);
|
|
|
|
#define COMPARE_SUB(v1, v2) \
|
|
ulong _u1 = (ulong)v1, _u2 = (ulong)v2, _u3 = (_u1 - _u2); \
|
|
\
|
|
if (_u1 < _u2) R(RFX) |= CF; \
|
|
else R(RFX) &= ~CF; \
|
|
\
|
|
if (((_u1 ^ _u3) & (_u1 ^ _u2)) >> 63) \
|
|
R(RFX) |= OF; \
|
|
else R(RFX) &= ~OF; \
|
|
\
|
|
SET_ZSF(_u3);
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#define CHK_SUPERV() \
|
|
do { \
|
|
if ((R(CR0) & UF) > 0) { \
|
|
_except(ctx, E_SYS, "Supervisor-only INSTR"); \
|
|
} \
|
|
} while (0)
|
|
|
|
//----------------------------------------------------------------------------//
|
|
|