#ifndef J3DTRANSFORM_H
#define J3DTRANSFORM_H

#include "JSystem/JGeometry.h"
#include "dolphin/mtx.h"

struct J3DTextureSRTInfo;

/**
 * @ingroup jsystem-j3d
 * 
 */

struct J3DTransformInfo {
    /* 0x00 */ Vec mScale;
    /* 0x0C */ SVec mRotation;
    /* 0x14 */ Vec mTranslate;

    /* inline J3DTransformInfo& operator=(const J3DTransformInfo& b) {
        mScale = b.mScale;
        mRotation = b.mRotation;
        mTranslate = b.mTranslate;
        return *this;
    } */

#ifdef __MWERKS__
    inline J3DTransformInfo& operator=(const register J3DTransformInfo& b) {
        register const J3DTransformInfo& var_r31 = b;
        register J3DTransformInfo& var_r30 = *this;

        register f32 var_f31;
        register f32 var_f0;
        register int var_r0;
        asm {
            psq_l var_f31, 0x0(var_r31), 0, 0
            psq_st var_f31, 0x0(var_r30), 0, 0
            lfs var_f0, 0x8(var_r31)
            stfs var_f0, 0x8(var_r30)
            lwz var_r0, 0xc(var_r31)
            stw var_r0, 0xc(var_r30)
            lha var_r0, 0x10(var_r31)
            sth var_r0, 0x10(var_r30)
            psq_l var_f31, 0x14(var_r31), 0, 0
            psq_st var_f31, 0x14(var_r30), 0, 0
            lfs var_f0, 0x1c(var_r31)
            stfs var_f0, 0x1c(var_r30)
        }
        return *this;
    }
#endif
};  // Size: 0x20

extern J3DTransformInfo const j3dDefaultTransformInfo;
extern Vec const j3dDefaultScale;
extern Mtx const j3dDefaultMtx;
extern f32 PSMulUnit01[2];

void J3DGQRSetup7(u32 param_0, u32 param_1, u32 param_2, u32 param_3);
void J3DCalcBBoardMtx(f32 (*)[4]);
void J3DCalcYBBoardMtx(f32 (*)[4]);
void J3DPSCalcInverseTranspose(f32 (*param_0)[4], f32 (*param_1)[3]);
void J3DGetTranslateRotateMtx(const J3DTransformInfo&, Mtx);
void J3DGetTranslateRotateMtx(s16, s16, s16, f32, f32, f32, Mtx);
void J3DGetTextureMtx(const J3DTextureSRTInfo&, const Vec&, f32 (*)[4]);
void J3DGetTextureMtxOld(const J3DTextureSRTInfo&, const Vec&, f32 (*)[4]);
void J3DGetTextureMtxMaya(const J3DTextureSRTInfo&, f32 (*)[4]);
void J3DGetTextureMtxMayaOld(const J3DTextureSRTInfo& param_0, f32 (*)[4]);
void J3DScaleNrmMtx(f32 (*)[4], const Vec&);
void J3DScaleNrmMtx33(f32 (*)[3], const Vec&);
void J3DMtxProjConcat(f32 (*)[4], f32 (*)[4], f32 (*)[4]);
void J3DPSMtxArrayConcat(f32 (*)[4], f32 (*)[4], f32 (*)[4], u32);

inline void J3DPSMtx33Copy(register Mtx3P src, register Mtx3P dst) {
    register f32 fr4;
    register f32 fr3;
    register f32 fr2;
    register f32 fr1;
    register f32 fr0;
    asm {
        psq_l fr4, 0(src), 0, 0
        psq_l fr3, 8(src), 0, 0
        psq_l fr2, 0x10(src), 0, 0
        psq_l fr1, 0x18(src), 0, 0
        lfs fr0, 0x20(src)
        psq_st fr4, 0(dst), 0, 0
        psq_st fr3, 8(dst), 0, 0
        psq_st fr2, 0x10(dst), 0, 0
        psq_st fr1, 0x18(dst), 0, 0
        stfs fr0, 0x20(dst)
    }
}

inline void J3DPSMtx33CopyFrom34(register MtxP src, register Mtx3P dst) {
    register f32 x_y1;
    register f32 z1;
    register f32 x_y2;
    register f32 z2;
    register f32 x_y3;
    register f32 z3;
    asm {
        psq_l x_y1, 0(src), 0, 0
        lfs z1, 8(src)
        psq_l x_y2, 16(src), 0, 0
        lfs z2, 0x18(src)
        psq_l x_y3, 32(src), 0, 0
        lfs z3, 0x28(src)
        psq_st x_y1, 0(dst), 0, 0
        stfs z1, 8(dst)
        psq_st x_y2, 12(dst), 0, 0
        stfs z2, 0x14(dst)
        psq_st x_y3, 24(dst), 0, 0
        stfs z3, 0x20(dst)
    }
}

// regalloc issues
inline void J3DPSMulMtxVec(register MtxP mtx, register Vec* vec, register Vec* dst) {
    register f32 fr12;
    register f32 fr11;
    register f32 fr10;
    register f32 fr9;
    register f32 fr8;
    register f32 fr6;
    register f32 fra6;
    register f32 fr5;
    register f32 fra5;
    register f32 fra4;
    register f32 fr4;
    register f32 fr3;
    register f32 fr2;
    register f32 fra2;
    register f32 fr01;
    register f32 fr00;
    asm {
        psq_l fr00, 0(vec), 0, 0
    	psq_l fr2, 0(mtx), 0, 0
    	psq_l fr01, 8(vec), 1, 0
    	ps_mul fr4, fr2, fr00
    	psq_l fr3, 8(mtx), 0, 0
    	ps_madd fr5, fr3, fr01, fr4
    	psq_l fr8, 16(mtx), 0, 0
    	ps_sum0 fr6, fr5, fr6, fr5
    	psq_l fr9, 24(mtx), 0, 0
    	ps_mul fr10, fr8, fr00
    	psq_st fr6, 0(dst), 1, 0
    	ps_madd fr11, fr9, fr01, fr10
    	psq_l fra2, 32(mtx), 0, 0
    	ps_sum0 fr12, fr11, fr12, fr11
    	psq_l fr3, 40(mtx), 0, 0
    	ps_mul fra4, fra2, fr00
    	psq_st fr12, 4(dst), 1, 0
    	ps_madd fra5, fr3, fr01, fra4
    	ps_sum0 fra6, fra5, fra6, fra5
    	psq_st fra6, 8(dst), 1, 0
    }
}

// regalloc issues
inline void J3DPSMulMtxVec(register MtxP mtx, register SVec* vec, register SVec* dst) {
    register f32 fr12;
    register f32 fr11;
    register f32 fr10;
    register f32 fr9;
    register f32 fr8;
    register f32 fr6;
    register f32 fra6;
    register f32 fr5;
    register f32 fra5;
    register f32 fra4;
    register f32 fr4;
    register f32 fr3;
    register f32 fr2;
    register f32 fra2;
    register f32 fr01;
    register f32 fr00;
    asm {
        psq_l fr00, 0(vec), 0, 7
    	psq_l fr2, 0(mtx), 0, 0
    	psq_l fr01, 4(vec), 1, 7
    	ps_mul fr4, fr2, fr00
    	psq_l fr3, 8(mtx), 0, 0
    	ps_madd fr5, fr3, fr01, fr4
    	psq_l fr8, 16(mtx), 0, 0
    	ps_sum0 fr6, fr5, fr6, fr5
    	psq_l fr9, 24(mtx), 0, 0
    	ps_mul fr10, fr8, fr00
    	psq_st fr6, 0(dst), 1, 7
    	ps_madd fr11, fr9, fr01, fr10
    	psq_l fra2, 32(mtx), 0, 0
    	ps_sum0 fr12, fr11, fr12, fr11
    	psq_l fr3, 40(mtx), 0, 0
    	ps_mul fra4, fra2, fr00
    	psq_st fr12, 2(dst), 1, 7
    	ps_madd fra5, fr3, fr01, fra4
    	ps_sum0 fra6, fra5, fra6, fra5
    	psq_st fra6, 4(dst), 1, 7
    }
}

// regalloc issues
inline void J3DPSMulMtxVec(register Mtx3P mtx, register Vec* vec, register Vec* dst) {
    register f32* punit;
    register f32 unit;
    register f32 fr12;
    register f32 fr11;
    register f32 fr10;
    register f32 fr9;
    register f32 fr8;
    register f32 fr6;
    register f32 fr5;
    register f32 fr4;
    register f32 fr3;
    register f32 fr2;
    register f32 fr01;
    register f32 fr00;
    asm {
        lis punit, PSMulUnit01@ha
        psq_l fr00, 0(vec), 0, 0
        addi punit, punit, PSMulUnit01@l
        psq_l fr2, 0(mtx), 0, 0
        psq_l unit, 0(punit), 0, 0
        psq_l fr01, 8(vec), 1, 0
        ps_add fr01, unit, fr01
        psq_l fr3, 8(mtx), 1, 0
        ps_mul fr4, fr2, fr00
        psq_l fr8, 12(mtx), 0, 0
        ps_madd fr5, fr3, fr01, fr4
        ps_sum0 fr6, fr5, fr6, fr5
        psq_l fr9, 20(mtx), 1, 0
        ps_mul fr10, fr8, fr00
        psq_st fr6, 0(dst), 1, 0
        ps_madd fr11, fr9, fr01, fr10
        psq_l fr2, 24(mtx), 0, 0
        ps_sum0 fr12, fr11, fr12, fr11
        psq_l fr3, 32(mtx), 1, 0
        ps_mul fr4, fr2, fr00
        psq_st fr12, 4(dst), 1, 0
        ps_madd fr5, fr3, fr01, fr4
        ps_sum0 fr6, fr5, fr6, fr5
        psq_st fr6, 8(dst), 1, 0
    }
}

// regalloc issues
inline void J3DPSMulMtxVec(register Mtx3P mtx, register SVec* vec, register SVec* dst) {
    register f32* punit;
    register f32 unit;
    register f32 fr6;
    register f32 fr5;
    register f32 fr4;
    register f32 fr3;
    register f32 fr2;
    register f32 fr01;
    register f32 fr00;
    asm {
        lis punit, PSMulUnit01@ha
        psq_l fr00, 0(vec), 0, 7
        addi punit, punit, PSMulUnit01@l
        psq_l fr2, 0(mtx), 0, 0
        psq_l unit, 0(punit), 0, 0
        psq_l fr01, 4(vec), 1, 7
        ps_add fr01, unit, fr01
        psq_l fr3, 8(mtx), 1, 0
        ps_mul fr4, fr2, fr00
        psq_l fr2, 12(mtx), 0, 0
        ps_madd fr5, fr3, fr01, fr4
        ps_sum0 fr6, fr5, fr6, fr5
        psq_l fr3, 20(mtx), 1, 0
        ps_mul fr4, fr2, fr00
        psq_st fr6, 0(dst), 1, 7
        ps_madd fr5, fr3, fr01, fr4
        psq_l fr2, 24(mtx), 0, 0
        ps_sum0 fr6, fr5, fr6, fr5
        psq_l fr3, 32(mtx), 1, 0
        ps_mul fr4, fr2, fr00
        psq_st fr6, 2(dst), 1, 7
        ps_madd fr5, fr3, fr01, fr4
        ps_sum0 fr6, fr5, fr6, fr5
        psq_st fr6, 4(dst), 1, 7
    }
}

#endif /* J3DTRANSFORM_H */