kvisc/vm/in/instrs.h

// 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)

//----------------------------------------------------------------------------//