mirror of
				https://github.com/hedge-dev/XenonRecomp.git
				synced 2025-10-30 07:11:38 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			660 lines
		
	
	
	
		
			20 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			660 lines
		
	
	
	
		
			20 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
#ifndef PPC_CONTEXT_H_INCLUDED
 | 
						|
#define PPC_CONTEXT_H_INCLUDED
 | 
						|
 | 
						|
#ifndef PPC_CONFIG_H_INCLUDED
 | 
						|
#error "ppc_config.h must be included before ppc_context.h"
 | 
						|
#endif
 | 
						|
 | 
						|
#include <climits>
 | 
						|
#include <cmath>
 | 
						|
#include <csetjmp>
 | 
						|
#include <cstdint>
 | 
						|
#include <cstdlib>
 | 
						|
#include <cstring>
 | 
						|
 | 
						|
#include <x86intrin.h>
 | 
						|
 | 
						|
#ifdef _WIN32
 | 
						|
#include <intrin.h>
 | 
						|
#else
 | 
						|
#include <xmmintrin.h>
 | 
						|
#include <smmintrin.h>
 | 
						|
#endif
 | 
						|
 | 
						|
#define PPC_JOIN(x, y) x##y
 | 
						|
#define PPC_XSTRINGIFY(x) #x
 | 
						|
#define PPC_STRINGIFY(x) PPC_XSTRINGIFY(x)
 | 
						|
#define PPC_FUNC(x) void x(PPCContext& __restrict ctx, uint8_t* base)
 | 
						|
#define PPC_FUNC_IMPL(x) extern "C" PPC_FUNC(x)
 | 
						|
#define PPC_EXTERN_FUNC(x) extern PPC_FUNC(x)
 | 
						|
#define PPC_WEAK_FUNC(x) __attribute__((weak,noinline)) PPC_FUNC(x)
 | 
						|
 | 
						|
#define PPC_FUNC_PROLOGUE() __builtin_assume(((size_t)base & 0x1F) == 0)
 | 
						|
 | 
						|
#ifndef PPC_LOAD_U8
 | 
						|
#define PPC_LOAD_U8(x) *(volatile uint8_t*)(base + (x))
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_LOAD_U16
 | 
						|
#define PPC_LOAD_U16(x) __builtin_bswap16(*(volatile uint16_t*)(base + (x)))
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_LOAD_U32
 | 
						|
#define PPC_LOAD_U32(x) __builtin_bswap32(*(volatile uint32_t*)(base + (x)))
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_LOAD_U64
 | 
						|
#define PPC_LOAD_U64(x) __builtin_bswap64(*(volatile uint64_t*)(base + (x)))
 | 
						|
#endif
 | 
						|
 | 
						|
// TODO: Implement.
 | 
						|
// These are currently unused. However, MMIO loads could possibly be handled statically with some profiling and a fallback.
 | 
						|
// The fallback would be a runtime exception handler which will intercept reads from MMIO regions 
 | 
						|
// and log the PC for compiling to static code later.
 | 
						|
#ifndef PPC_MM_LOAD_U8
 | 
						|
#define PPC_MM_LOAD_U8(x)  PPC_LOAD_U8 (x)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_MM_LOAD_U16
 | 
						|
#define PPC_MM_LOAD_U16(x) PPC_LOAD_U16(x)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_MM_LOAD_U32
 | 
						|
#define PPC_MM_LOAD_U32(x) PPC_LOAD_U32(x)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_MM_LOAD_U64
 | 
						|
#define PPC_MM_LOAD_U64(x) PPC_LOAD_U64(x)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_STORE_U8
 | 
						|
#define PPC_STORE_U8(x, y) *(volatile uint8_t*)(base + (x)) = (y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_STORE_U16
 | 
						|
#define PPC_STORE_U16(x, y) *(volatile uint16_t*)(base + (x)) = __builtin_bswap16(y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_STORE_U32
 | 
						|
#define PPC_STORE_U32(x, y) *(volatile uint32_t*)(base + (x)) = __builtin_bswap32(y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_STORE_U64
 | 
						|
#define PPC_STORE_U64(x, y) *(volatile uint64_t*)(base + (x)) = __builtin_bswap64(y)
 | 
						|
#endif
 | 
						|
 | 
						|
// MMIO Store handling is completely reliant on being preeceded by eieio.
 | 
						|
// TODO: Verify if that's always the case.
 | 
						|
#ifndef PPC_MM_STORE_U8
 | 
						|
#define PPC_MM_STORE_U8(x, y)   PPC_STORE_U8 (x, y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_MM_STORE_U16
 | 
						|
#define PPC_MM_STORE_U16(x, y)  PPC_STORE_U16(x, y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_MM_STORE_U32
 | 
						|
#define PPC_MM_STORE_U32(x, y)  PPC_STORE_U32(x, y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_MM_STORE_U64
 | 
						|
#define PPC_MM_STORE_U64(x, y)  PPC_STORE_U64(x, y)
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_CALL_FUNC
 | 
						|
#define PPC_CALL_FUNC(x) x(ctx, base)
 | 
						|
#endif
 | 
						|
 | 
						|
#define PPC_MEMORY_SIZE 0x100000000ull
 | 
						|
 | 
						|
#define PPC_LOOKUP_FUNC(x, y) *(PPCFunc**)(x + PPC_IMAGE_BASE + PPC_IMAGE_SIZE + (uint64_t(uint32_t(y) - PPC_CODE_BASE) * 2))
 | 
						|
 | 
						|
#ifndef PPC_CALL_INDIRECT_FUNC
 | 
						|
#define PPC_CALL_INDIRECT_FUNC(x) (PPC_LOOKUP_FUNC(base, x))(ctx, base)
 | 
						|
#endif
 | 
						|
 | 
						|
typedef void PPCFunc(struct PPCContext& __restrict__ ctx, uint8_t* base);
 | 
						|
 | 
						|
struct PPCFuncMapping
 | 
						|
{
 | 
						|
    size_t guest;
 | 
						|
    PPCFunc* host;
 | 
						|
};
 | 
						|
 | 
						|
extern PPCFuncMapping PPCFuncMappings[];
 | 
						|
 | 
						|
struct PPCRegister
 | 
						|
{
 | 
						|
    union
 | 
						|
    {
 | 
						|
        int8_t s8;
 | 
						|
        uint8_t u8;
 | 
						|
        int16_t s16;
 | 
						|
        uint16_t u16;
 | 
						|
        int32_t s32;
 | 
						|
        uint32_t u32;
 | 
						|
        int64_t s64;
 | 
						|
        uint64_t u64;
 | 
						|
        float f32;
 | 
						|
        double f64;
 | 
						|
    };
 | 
						|
};
 | 
						|
 | 
						|
struct PPCXERRegister
 | 
						|
{
 | 
						|
    uint8_t so;
 | 
						|
    uint8_t ov;
 | 
						|
    uint8_t ca;
 | 
						|
};
 | 
						|
 | 
						|
struct PPCCRRegister
 | 
						|
{
 | 
						|
    uint8_t lt;
 | 
						|
    uint8_t gt;
 | 
						|
    uint8_t eq;
 | 
						|
    union
 | 
						|
    {
 | 
						|
        uint8_t so;
 | 
						|
        uint8_t un;
 | 
						|
    };
 | 
						|
 | 
						|
    template<typename T>
 | 
						|
    inline void compare(T left, T right, const PPCXERRegister& xer) noexcept
 | 
						|
    {
 | 
						|
        lt = left < right;
 | 
						|
        gt = left > right;
 | 
						|
        eq = left == right;
 | 
						|
        so = xer.so;
 | 
						|
    }
 | 
						|
 | 
						|
    inline void compare(double left, double right) noexcept
 | 
						|
    {
 | 
						|
        un = __builtin_isnan(left) || __builtin_isnan(right);
 | 
						|
        lt = !un && (left < right);
 | 
						|
        gt = !un && (left > right);
 | 
						|
        eq = !un && (left == right);
 | 
						|
    }
 | 
						|
 | 
						|
    inline void setFromMask(__m128 mask, int imm) noexcept
 | 
						|
    {
 | 
						|
        int m = _mm_movemask_ps(mask);
 | 
						|
        lt = m == imm; // all equal
 | 
						|
        gt = 0;
 | 
						|
        eq = m == 0; // none equal
 | 
						|
        so = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    inline void setFromMask(__m128i mask, int imm) noexcept
 | 
						|
    {
 | 
						|
        int m = _mm_movemask_epi8(mask);
 | 
						|
        lt = m == imm; // all equal
 | 
						|
        gt = 0;
 | 
						|
        eq = m == 0; // none equal
 | 
						|
        so = 0;
 | 
						|
    }
 | 
						|
};
 | 
						|
 | 
						|
struct alignas(0x10) PPCVRegister
 | 
						|
{
 | 
						|
    union
 | 
						|
    {
 | 
						|
        int8_t s8[16];
 | 
						|
        uint8_t u8[16];
 | 
						|
        int16_t s16[8];
 | 
						|
        uint16_t u16[8];
 | 
						|
        int32_t s32[4];
 | 
						|
        uint32_t u32[4];
 | 
						|
        int64_t s64[2];
 | 
						|
        uint64_t u64[2];
 | 
						|
        float f32[4];
 | 
						|
        double f64[2];
 | 
						|
    };
 | 
						|
};
 | 
						|
 | 
						|
#define PPC_ROUND_NEAREST 0x00
 | 
						|
#define PPC_ROUND_TOWARD_ZERO 0x01
 | 
						|
#define PPC_ROUND_UP 0x02
 | 
						|
#define PPC_ROUND_DOWN 0x03
 | 
						|
#define PPC_ROUND_MASK 0x03
 | 
						|
 | 
						|
struct PPCFPSCRRegister
 | 
						|
{
 | 
						|
    uint32_t csr;
 | 
						|
 | 
						|
    static constexpr size_t GuestToHost[] = { _MM_ROUND_NEAREST, _MM_ROUND_TOWARD_ZERO, _MM_ROUND_UP, _MM_ROUND_DOWN };
 | 
						|
    static constexpr size_t HostToGuest[] = { PPC_ROUND_NEAREST, PPC_ROUND_DOWN, PPC_ROUND_UP, PPC_ROUND_TOWARD_ZERO };
 | 
						|
 | 
						|
    inline uint32_t loadFromHost() noexcept
 | 
						|
    {
 | 
						|
        csr = _mm_getcsr();
 | 
						|
        return HostToGuest[(csr & _MM_ROUND_MASK) >> 13];
 | 
						|
    }
 | 
						|
        
 | 
						|
    inline void storeFromGuest(uint32_t value) noexcept
 | 
						|
    {
 | 
						|
        csr &= ~_MM_ROUND_MASK;
 | 
						|
        csr |= GuestToHost[value & PPC_ROUND_MASK];
 | 
						|
        _mm_setcsr(csr);
 | 
						|
    }
 | 
						|
 | 
						|
    static constexpr size_t FlushMask = _MM_FLUSH_ZERO_MASK | _MM_DENORMALS_ZERO_MASK;
 | 
						|
 | 
						|
    inline void enableFlushModeUnconditional() noexcept
 | 
						|
    {
 | 
						|
        csr |= FlushMask;
 | 
						|
        _mm_setcsr(csr);
 | 
						|
    }
 | 
						|
 | 
						|
    inline void disableFlushModeUnconditional() noexcept
 | 
						|
    {
 | 
						|
        csr &= ~FlushMask;
 | 
						|
        _mm_setcsr(csr);
 | 
						|
    }
 | 
						|
 | 
						|
    inline void enableFlushMode() noexcept
 | 
						|
    {
 | 
						|
        if ((csr & FlushMask) != FlushMask) [[unlikely]]
 | 
						|
        {
 | 
						|
            csr |= FlushMask;
 | 
						|
            _mm_setcsr(csr);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    inline void disableFlushMode() noexcept
 | 
						|
    {
 | 
						|
        if ((csr & FlushMask) != 0) [[unlikely]]
 | 
						|
        {
 | 
						|
            csr &= ~FlushMask;
 | 
						|
            _mm_setcsr(csr);
 | 
						|
        }
 | 
						|
    }
 | 
						|
};
 | 
						|
 | 
						|
struct PPCContext
 | 
						|
{
 | 
						|
    PPCRegister r3;
 | 
						|
#ifndef PPC_CONFIG_NON_ARGUMENT_AS_LOCAL
 | 
						|
    PPCRegister r0;
 | 
						|
#endif
 | 
						|
    PPCRegister r1;
 | 
						|
#ifndef PPC_CONFIG_NON_ARGUMENT_AS_LOCAL
 | 
						|
    PPCRegister r2;
 | 
						|
#endif
 | 
						|
    PPCRegister r4;
 | 
						|
    PPCRegister r5;
 | 
						|
    PPCRegister r6;
 | 
						|
    PPCRegister r7;
 | 
						|
    PPCRegister r8;
 | 
						|
    PPCRegister r9;
 | 
						|
    PPCRegister r10;
 | 
						|
#ifndef PPC_CONFIG_NON_ARGUMENT_AS_LOCAL
 | 
						|
    PPCRegister r11;
 | 
						|
    PPCRegister r12;
 | 
						|
#endif
 | 
						|
    PPCRegister r13;
 | 
						|
#ifndef PPC_CONFIG_NON_VOLATILE_AS_LOCAL
 | 
						|
    PPCRegister r14;
 | 
						|
    PPCRegister r15;
 | 
						|
    PPCRegister r16;
 | 
						|
    PPCRegister r17;
 | 
						|
    PPCRegister r18;
 | 
						|
    PPCRegister r19;
 | 
						|
    PPCRegister r20;
 | 
						|
    PPCRegister r21;
 | 
						|
    PPCRegister r22;
 | 
						|
    PPCRegister r23;
 | 
						|
    PPCRegister r24;
 | 
						|
    PPCRegister r25;
 | 
						|
    PPCRegister r26;
 | 
						|
    PPCRegister r27;
 | 
						|
    PPCRegister r28;
 | 
						|
    PPCRegister r29;
 | 
						|
    PPCRegister r30;
 | 
						|
    PPCRegister r31;
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef PPC_CONFIG_SKIP_LR
 | 
						|
    uint64_t lr;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_CTR_AS_LOCAL
 | 
						|
    PPCRegister ctr;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_XER_AS_LOCAL
 | 
						|
    PPCXERRegister xer;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_RESERVED_AS_LOCAL
 | 
						|
    PPCRegister reserved;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_SKIP_MSR
 | 
						|
    uint32_t msr = 0x200A000;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_CR_AS_LOCAL
 | 
						|
    PPCCRRegister cr0;
 | 
						|
    PPCCRRegister cr1;
 | 
						|
    PPCCRRegister cr2;
 | 
						|
    PPCCRRegister cr3;
 | 
						|
    PPCCRRegister cr4;
 | 
						|
    PPCCRRegister cr5;
 | 
						|
    PPCCRRegister cr6;
 | 
						|
    PPCCRRegister cr7;
 | 
						|
#endif
 | 
						|
    PPCFPSCRRegister fpscr;
 | 
						|
 | 
						|
#ifndef PPC_CONFIG_NON_ARGUMENT_AS_LOCAL
 | 
						|
    PPCRegister f0;
 | 
						|
#endif
 | 
						|
    PPCRegister f1;
 | 
						|
    PPCRegister f2;
 | 
						|
    PPCRegister f3;
 | 
						|
    PPCRegister f4;
 | 
						|
    PPCRegister f5;
 | 
						|
    PPCRegister f6;
 | 
						|
    PPCRegister f7;
 | 
						|
    PPCRegister f8;
 | 
						|
    PPCRegister f9;
 | 
						|
    PPCRegister f10;
 | 
						|
    PPCRegister f11;
 | 
						|
    PPCRegister f12;
 | 
						|
    PPCRegister f13;
 | 
						|
#ifndef PPC_CONFIG_NON_VOLATILE_AS_LOCAL
 | 
						|
    PPCRegister f14;
 | 
						|
    PPCRegister f15;
 | 
						|
    PPCRegister f16;
 | 
						|
    PPCRegister f17;
 | 
						|
    PPCRegister f18;
 | 
						|
    PPCRegister f19;
 | 
						|
    PPCRegister f20;
 | 
						|
    PPCRegister f21;
 | 
						|
    PPCRegister f22;
 | 
						|
    PPCRegister f23;
 | 
						|
    PPCRegister f24;
 | 
						|
    PPCRegister f25;
 | 
						|
    PPCRegister f26;
 | 
						|
    PPCRegister f27;
 | 
						|
    PPCRegister f28;
 | 
						|
    PPCRegister f29;
 | 
						|
    PPCRegister f30;
 | 
						|
    PPCRegister f31;
 | 
						|
#endif
 | 
						|
 | 
						|
    PPCVRegister v0;
 | 
						|
    PPCVRegister v1;
 | 
						|
    PPCVRegister v2;
 | 
						|
    PPCVRegister v3;
 | 
						|
    PPCVRegister v4;
 | 
						|
    PPCVRegister v5;
 | 
						|
    PPCVRegister v6;
 | 
						|
    PPCVRegister v7;
 | 
						|
    PPCVRegister v8;
 | 
						|
    PPCVRegister v9;
 | 
						|
    PPCVRegister v10;
 | 
						|
    PPCVRegister v11;
 | 
						|
    PPCVRegister v12;
 | 
						|
    PPCVRegister v13;
 | 
						|
#ifndef PPC_CONFIG_NON_VOLATILE_AS_LOCAL
 | 
						|
    PPCVRegister v14;
 | 
						|
    PPCVRegister v15;
 | 
						|
    PPCVRegister v16;
 | 
						|
    PPCVRegister v17;
 | 
						|
    PPCVRegister v18;
 | 
						|
    PPCVRegister v19;
 | 
						|
    PPCVRegister v20;
 | 
						|
    PPCVRegister v21;
 | 
						|
    PPCVRegister v22;
 | 
						|
    PPCVRegister v23;
 | 
						|
    PPCVRegister v24;
 | 
						|
    PPCVRegister v25;
 | 
						|
    PPCVRegister v26;
 | 
						|
    PPCVRegister v27;
 | 
						|
    PPCVRegister v28;
 | 
						|
    PPCVRegister v29;
 | 
						|
    PPCVRegister v30;
 | 
						|
    PPCVRegister v31;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_NON_ARGUMENT_AS_LOCAL
 | 
						|
    PPCVRegister v32;
 | 
						|
    PPCVRegister v33;
 | 
						|
    PPCVRegister v34;
 | 
						|
    PPCVRegister v35;
 | 
						|
    PPCVRegister v36;
 | 
						|
    PPCVRegister v37;
 | 
						|
    PPCVRegister v38;
 | 
						|
    PPCVRegister v39;
 | 
						|
    PPCVRegister v40;
 | 
						|
    PPCVRegister v41;
 | 
						|
    PPCVRegister v42;
 | 
						|
    PPCVRegister v43;
 | 
						|
    PPCVRegister v44;
 | 
						|
    PPCVRegister v45;
 | 
						|
    PPCVRegister v46;
 | 
						|
    PPCVRegister v47;
 | 
						|
    PPCVRegister v48;
 | 
						|
    PPCVRegister v49;
 | 
						|
    PPCVRegister v50;
 | 
						|
    PPCVRegister v51;
 | 
						|
    PPCVRegister v52;
 | 
						|
    PPCVRegister v53;
 | 
						|
    PPCVRegister v54;
 | 
						|
    PPCVRegister v55;
 | 
						|
    PPCVRegister v56;
 | 
						|
    PPCVRegister v57;
 | 
						|
    PPCVRegister v58;
 | 
						|
    PPCVRegister v59;
 | 
						|
    PPCVRegister v60;
 | 
						|
    PPCVRegister v61;
 | 
						|
    PPCVRegister v62;
 | 
						|
    PPCVRegister v63;
 | 
						|
#endif
 | 
						|
#ifndef PPC_CONFIG_NON_VOLATILE_AS_LOCAL
 | 
						|
    PPCVRegister v64;
 | 
						|
    PPCVRegister v65;
 | 
						|
    PPCVRegister v66;
 | 
						|
    PPCVRegister v67;
 | 
						|
    PPCVRegister v68;
 | 
						|
    PPCVRegister v69;
 | 
						|
    PPCVRegister v70;
 | 
						|
    PPCVRegister v71;
 | 
						|
    PPCVRegister v72;
 | 
						|
    PPCVRegister v73;
 | 
						|
    PPCVRegister v74;
 | 
						|
    PPCVRegister v75;
 | 
						|
    PPCVRegister v76;
 | 
						|
    PPCVRegister v77;
 | 
						|
    PPCVRegister v78;
 | 
						|
    PPCVRegister v79;
 | 
						|
    PPCVRegister v80;
 | 
						|
    PPCVRegister v81;
 | 
						|
    PPCVRegister v82;
 | 
						|
    PPCVRegister v83;
 | 
						|
    PPCVRegister v84;
 | 
						|
    PPCVRegister v85;
 | 
						|
    PPCVRegister v86;
 | 
						|
    PPCVRegister v87;
 | 
						|
    PPCVRegister v88;
 | 
						|
    PPCVRegister v89;
 | 
						|
    PPCVRegister v90;
 | 
						|
    PPCVRegister v91;
 | 
						|
    PPCVRegister v92;
 | 
						|
    PPCVRegister v93;
 | 
						|
    PPCVRegister v94;
 | 
						|
    PPCVRegister v95;
 | 
						|
    PPCVRegister v96;
 | 
						|
    PPCVRegister v97;
 | 
						|
    PPCVRegister v98;
 | 
						|
    PPCVRegister v99;
 | 
						|
    PPCVRegister v100;
 | 
						|
    PPCVRegister v101;
 | 
						|
    PPCVRegister v102;
 | 
						|
    PPCVRegister v103;
 | 
						|
    PPCVRegister v104;
 | 
						|
    PPCVRegister v105;
 | 
						|
    PPCVRegister v106;
 | 
						|
    PPCVRegister v107;
 | 
						|
    PPCVRegister v108;
 | 
						|
    PPCVRegister v109;
 | 
						|
    PPCVRegister v110;
 | 
						|
    PPCVRegister v111;
 | 
						|
    PPCVRegister v112;
 | 
						|
    PPCVRegister v113;
 | 
						|
    PPCVRegister v114;
 | 
						|
    PPCVRegister v115;
 | 
						|
    PPCVRegister v116;
 | 
						|
    PPCVRegister v117;
 | 
						|
    PPCVRegister v118;
 | 
						|
    PPCVRegister v119;
 | 
						|
    PPCVRegister v120;
 | 
						|
    PPCVRegister v121;
 | 
						|
    PPCVRegister v122;
 | 
						|
    PPCVRegister v123;
 | 
						|
    PPCVRegister v124;
 | 
						|
    PPCVRegister v125;
 | 
						|
    PPCVRegister v126;
 | 
						|
    PPCVRegister v127;
 | 
						|
#endif
 | 
						|
};
 | 
						|
 | 
						|
inline uint8_t VectorMaskL[] =
 | 
						|
{
 | 
						|
    0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00,
 | 
						|
    0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01,
 | 
						|
    0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02,
 | 
						|
    0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D, 0x0C,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E, 0x0D,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0E,
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F,
 | 
						|
};
 | 
						|
 | 
						|
inline uint8_t VectorMaskR[] =
 | 
						|
{
 | 
						|
    0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF, 0xFF,
 | 
						|
    0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF, 0xFF,
 | 
						|
    0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00, 0xFF,
 | 
						|
};
 | 
						|
 | 
						|
inline uint8_t VectorShiftTableL[] =
 | 
						|
{
 | 
						|
    0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01, 0x00,
 | 
						|
    0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01,
 | 
						|
    0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02,
 | 
						|
    0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03,
 | 
						|
    0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04,
 | 
						|
    0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05,
 | 
						|
    0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06,
 | 
						|
    0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07,
 | 
						|
    0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08,
 | 
						|
    0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09,
 | 
						|
    0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A,
 | 
						|
    0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B,
 | 
						|
    0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C,
 | 
						|
    0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D,
 | 
						|
    0x1D, 0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E,
 | 
						|
    0x1E, 0x1D, 0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F,
 | 
						|
};
 | 
						|
 | 
						|
inline uint8_t VectorShiftTableR[] =
 | 
						|
{
 | 
						|
    0x1F, 0x1E, 0x1D, 0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10,
 | 
						|
    0x1E, 0x1D, 0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F,
 | 
						|
    0x1D, 0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E,
 | 
						|
    0x1C, 0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D,
 | 
						|
    0x1B, 0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C,
 | 
						|
    0x1A, 0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B,
 | 
						|
    0x19, 0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A,
 | 
						|
    0x18, 0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09,
 | 
						|
    0x17, 0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08,
 | 
						|
    0x16, 0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07,
 | 
						|
    0x15, 0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06,
 | 
						|
    0x14, 0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05,
 | 
						|
    0x13, 0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04,
 | 
						|
    0x12, 0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03,
 | 
						|
    0x11, 0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02,
 | 
						|
    0x10, 0x0F, 0x0E, 0x0D, 0x0C, 0x0B, 0x0A, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x02, 0x01,
 | 
						|
};
 | 
						|
 | 
						|
inline __m128i _mm_adds_epu32(__m128i a, __m128i b) 
 | 
						|
{
 | 
						|
    return _mm_add_epi32(a, _mm_min_epu32(_mm_xor_si128(a, _mm_cmpeq_epi32(a, a)), b));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_avg_epi8(__m128i a, __m128i b)
 | 
						|
{
 | 
						|
    __m128i c = _mm_set1_epi8(char(128));
 | 
						|
    return _mm_xor_si128(c, _mm_avg_epu8(_mm_xor_si128(c, a), _mm_xor_si128(c, b)));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_avg_epi16(__m128i a, __m128i b)
 | 
						|
{
 | 
						|
    __m128i c = _mm_set1_epi16(short(32768));
 | 
						|
    return _mm_xor_si128(c, _mm_avg_epu16(_mm_xor_si128(c, a), _mm_xor_si128(c, b)));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128 _mm_cvtepu32_ps_(__m128i src1)
 | 
						|
{
 | 
						|
    __m128i xmm1 = _mm_add_epi32(src1, _mm_set1_epi32(127));
 | 
						|
    __m128i xmm0 = _mm_slli_epi32(src1, 31 - 8);
 | 
						|
    xmm0 = _mm_srli_epi32(xmm0, 31);
 | 
						|
    xmm0 = _mm_add_epi32(xmm0, xmm1);
 | 
						|
    xmm0 = _mm_srai_epi32(xmm0, 8);
 | 
						|
    xmm0 = _mm_add_epi32(xmm0, _mm_set1_epi32(0x4F800000));
 | 
						|
    __m128 xmm2 = _mm_cvtepi32_ps(src1);
 | 
						|
    return _mm_blendv_ps(xmm2, _mm_castsi128_ps(xmm0), _mm_castsi128_ps(src1));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_perm_epi8_(__m128i a, __m128i b, __m128i c)
 | 
						|
{
 | 
						|
    __m128i d = _mm_set1_epi8(0xF);
 | 
						|
    __m128i e = _mm_sub_epi8(d, _mm_and_si128(c, d));
 | 
						|
    return _mm_blendv_epi8(_mm_shuffle_epi8(a, e), _mm_shuffle_epi8(b, e), _mm_slli_epi32(c, 3));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_cmpgt_epu8(__m128i a, __m128i b)
 | 
						|
{
 | 
						|
    __m128i c = _mm_set1_epi8(char(128));
 | 
						|
    return _mm_cmpgt_epi8(_mm_xor_si128(a, c), _mm_xor_si128(b, c));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_cmpgt_epu16(__m128i a, __m128i b)
 | 
						|
{
 | 
						|
    __m128i c = _mm_set1_epi16(short(32768));
 | 
						|
    return _mm_cmpgt_epi16(_mm_xor_si128(a, c), _mm_xor_si128(b, c));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_vctsxs(__m128 src1)
 | 
						|
{
 | 
						|
    __m128 xmm2 = _mm_cmpunord_ps(src1, src1);
 | 
						|
    __m128i xmm0 = _mm_cvttps_epi32(src1);
 | 
						|
    __m128i xmm1 = _mm_cmpeq_epi32(xmm0, _mm_set1_epi32(INT_MIN));
 | 
						|
    xmm1 = _mm_andnot_si128(_mm_castps_si128(src1), xmm1);
 | 
						|
    __m128 dest = _mm_blendv_ps(_mm_castsi128_ps(xmm0), _mm_castsi128_ps(_mm_set1_epi32(INT_MAX)), _mm_castsi128_ps(xmm1));
 | 
						|
    return _mm_andnot_si128(_mm_castps_si128(xmm2), _mm_castps_si128(dest));
 | 
						|
}
 | 
						|
 | 
						|
inline __m128i _mm_vsr(__m128i a, __m128i b)
 | 
						|
{
 | 
						|
    b = _mm_srli_epi64(_mm_slli_epi64(b, 61), 61);
 | 
						|
    return _mm_castps_si128(_mm_insert_ps(_mm_castsi128_ps(_mm_srl_epi64(a, b)), _mm_castsi128_ps(_mm_srl_epi64(_mm_srli_si128(a, 4), b)), 0x10));
 | 
						|
}
 | 
						|
 | 
						|
#endif
 |