2019-06-11 06:59:28 +00:00
|
|
|
#include "common.h"
|
2020-04-17 13:31:11 +00:00
|
|
|
|
2020-08-03 10:58:37 +00:00
|
|
|
#include "VuVector.h"
|
2019-06-11 06:59:28 +00:00
|
|
|
|
|
|
|
|
// TODO: move more stuff into here
|
|
|
|
|
|
2020-08-03 10:58:37 +00:00
|
|
|
|
|
|
|
|
void TransformPoint(CVuVector &out, const CMatrix &mat, const CVuVector &in)
|
|
|
|
|
{
|
|
|
|
|
#ifdef GTA_PS2
|
|
|
|
|
__asm__ __volatile__("\n\
|
|
|
|
|
lqc2 vf01,0x0(%2)\n\
|
|
|
|
|
lqc2 vf02,0x0(%1)\n\
|
|
|
|
|
lqc2 vf03,0x10(%1)\n\
|
|
|
|
|
lqc2 vf04,0x20(%1)\n\
|
|
|
|
|
lqc2 vf05,0x30(%1)\n\
|
|
|
|
|
vmulax.xyz ACC, vf02,vf01\n\
|
|
|
|
|
vmadday.xyz ACC, vf03,vf01\n\
|
|
|
|
|
vmaddaz.xyz ACC, vf04,vf01\n\
|
|
|
|
|
vmaddw.xyz vf06,vf05,vf00\n\
|
|
|
|
|
sqc2 vf06,0x0(%0)\n\
|
|
|
|
|
": : "r" (&out) , "r" (&mat) ,"r" (&in): "memory");
|
|
|
|
|
#else
|
|
|
|
|
out = mat * in;
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void TransformPoint(CVuVector &out, const CMatrix &mat, const RwV3d &in)
|
|
|
|
|
{
|
|
|
|
|
#ifdef GTA_PS2
|
|
|
|
|
__asm__ __volatile__("\n\
|
|
|
|
|
ldr $8,0x0(%2)\n\
|
|
|
|
|
ldl $8,0x7(%2)\n\
|
|
|
|
|
lw $9,0x8(%2)\n\
|
|
|
|
|
pcpyld $10,$9,$8\n\
|
|
|
|
|
qmtc2 $10,vf01\n\
|
|
|
|
|
lqc2 vf02,0x0(%1)\n\
|
|
|
|
|
lqc2 vf03,0x10(%1)\n\
|
|
|
|
|
lqc2 vf04,0x20(%1)\n\
|
|
|
|
|
lqc2 vf05,0x30(%1)\n\
|
|
|
|
|
vmulax.xyz ACC, vf02,vf01\n\
|
|
|
|
|
vmadday.xyz ACC, vf03,vf01\n\
|
|
|
|
|
vmaddaz.xyz ACC, vf04,vf01\n\
|
|
|
|
|
vmaddw.xyz vf06,vf05,vf00\n\
|
|
|
|
|
sqc2 vf06,0x0(%0)\n\
|
|
|
|
|
": : "r" (&out) , "r" (&mat) ,"r" (&in): "memory");
|
|
|
|
|
#else
|
|
|
|
|
out = mat * in;
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void TransformPoints(CVuVector *out, int n, const CMatrix &mat, const RwV3d *in, int stride)
|
|
|
|
|
{
|
|
|
|
|
#ifdef GTA_PS3
|
|
|
|
|
__asm__ __volatile__("\n\
|
|
|
|
|
paddub $3,%4,$0\n\
|
|
|
|
|
lqc2 vf02,0x0(%2)\n\
|
|
|
|
|
lqc2 vf03,0x10(%2)\n\
|
|
|
|
|
lqc2 vf04,0x20(%2)\n\
|
|
|
|
|
lqc2 vf05,0x30(%2)\n\
|
|
|
|
|
ldr $8,0x0(%3)\n\
|
|
|
|
|
ldl $8,0x7(%3)\n\
|
|
|
|
|
lw $9,0x8(%3)\n\
|
|
|
|
|
pcpyld $10,$9,$8\n\
|
|
|
|
|
qmtc2 $10,vf01\n\
|
|
|
|
|
1: vmulax.xyz ACC, vf02,vf01\n\
|
|
|
|
|
vmadday.xyz ACC, vf03,vf01\n\
|
|
|
|
|
vmaddaz.xyz ACC, vf04,vf01\n\
|
|
|
|
|
vmaddw.xyz vf06,vf05,vf00\n\
|
|
|
|
|
add %3,%3,$3\n\
|
|
|
|
|
ldr $8,0x0(%3)\n\
|
|
|
|
|
ldl $8,0x7(%3)\n\
|
|
|
|
|
lw $9,0x8(%3)\n\
|
|
|
|
|
pcpyld $10,$9,$8\n\
|
|
|
|
|
qmtc2 $10,vf01\n\
|
|
|
|
|
addi %1,%1,-1\n\
|
|
|
|
|
addiu %0,%0,0x10\n\
|
|
|
|
|
sqc2 vf06,-0x10(%0)\n\
|
|
|
|
|
bnez %1,1b\n\
|
|
|
|
|
": : "r" (out) , "r" (n), "r" (&mat), "r" (in), "r" (stride): "memory");
|
|
|
|
|
#else
|
|
|
|
|
while(n--){
|
|
|
|
|
*out = mat * *in;
|
|
|
|
|
in = (RwV3d*)((uint8*)in + stride);
|
|
|
|
|
out++;
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void TransformPoints(CVuVector *out, int n, const CMatrix &mat, const CVuVector *in)
|
|
|
|
|
{
|
|
|
|
|
#ifdef GTA_PS2
|
|
|
|
|
__asm__ __volatile__("\n\
|
|
|
|
|
lqc2 vf02,0x0(%2)\n\
|
|
|
|
|
lqc2 vf03,0x10(%2)\n\
|
|
|
|
|
lqc2 vf04,0x20(%2)\n\
|
|
|
|
|
lqc2 vf05,0x30(%2)\n\
|
|
|
|
|
lqc2 vf01,0x0(%3)\n\
|
|
|
|
|
nop\n\
|
|
|
|
|
1: vmulax.xyz ACC, vf02,vf01\n\
|
|
|
|
|
vmadday.xyz ACC, vf03,vf01\n\
|
|
|
|
|
vmaddaz.xyz ACC, vf04,vf01\n\
|
|
|
|
|
vmaddw.xyz vf06,vf05,vf00\n\
|
|
|
|
|
lqc2 vf01,0x10(%3)\n\
|
|
|
|
|
addiu %3,%3,0x10\n\
|
|
|
|
|
addi %1,%1,-1\n\
|
|
|
|
|
addiu %0,%0,0x10\n\
|
|
|
|
|
sqc2 vf06,-0x10(%0)\n\
|
|
|
|
|
bnez %1,1b\n\
|
|
|
|
|
": : "r" (out) , "r" (n), "r" (&mat) ,"r" (in): "memory");
|
|
|
|
|
#else
|
|
|
|
|
while(n--){
|
|
|
|
|
*out = mat * *in;
|
|
|
|
|
in++;
|
|
|
|
|
out++;
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
}
|
