mirror of
https://git.rip/DMCA_FUCKER/re3.git
synced 2024-12-22 23:50:00 +00:00
commit
0d7fa6df3c
File diff suppressed because it is too large
Load diff
|
@ -2,6 +2,9 @@
|
|||
|
||||
#include "templates.h"
|
||||
#include "Game.h" // for eLevelName
|
||||
#ifdef VU_COLLISION
|
||||
#include "VuVector.h"
|
||||
#endif
|
||||
|
||||
// If you spawn many tanks at once, you will see that collisions of two entity exceeds 32.
|
||||
#ifdef FIX_BUGS
|
||||
|
@ -16,6 +19,28 @@ struct CompressedVector
|
|||
int16 x, y, z;
|
||||
CVector Get(void) const { return CVector(x, y, z)/128.0f; };
|
||||
void Set(float x, float y, float z) { this->x = x*128.0f; this->y = y*128.0f; this->z = z*128.0f; };
|
||||
#ifdef GTA_PS2
|
||||
void Unpack(uint128 &qword) const {
|
||||
__asm__ volatile (
|
||||
"lh $8, 0(%1)\n"
|
||||
"lh $9, 2(%1)\n"
|
||||
"lh $10, 4(%1)\n"
|
||||
"pextlw $10, $8\n"
|
||||
"pextlw $2, $9, $10\n"
|
||||
"sq $2, %0\n"
|
||||
: "=m" (qword)
|
||||
: "r" (this)
|
||||
: "$8", "$9", "$10", "$2"
|
||||
);
|
||||
}
|
||||
#else
|
||||
void Unpack(int32 *qword) const {
|
||||
qword[0] = x;
|
||||
qword[1] = y;
|
||||
qword[2] = z;
|
||||
qword[3] = 0; // junk
|
||||
}
|
||||
#endif
|
||||
#else
|
||||
float x, y, z;
|
||||
CVector Get(void) const { return CVector(x, y, z); };
|
||||
|
@ -25,6 +50,7 @@ struct CompressedVector
|
|||
|
||||
struct CColSphere
|
||||
{
|
||||
// NB: this has to be compatible with a CVuVector
|
||||
CVector center;
|
||||
float radius;
|
||||
uint8 surface;
|
||||
|
@ -47,6 +73,7 @@ struct CColBox
|
|||
|
||||
struct CColLine
|
||||
{
|
||||
// NB: this has to be compatible with two CVuVectors
|
||||
CVector p0;
|
||||
int pad0;
|
||||
CVector p1;
|
||||
|
@ -69,6 +96,39 @@ struct CColTriangle
|
|||
|
||||
struct CColTrianglePlane
|
||||
{
|
||||
#ifdef VU_COLLISION
|
||||
CompressedVector normal;
|
||||
int16 dist;
|
||||
|
||||
void Set(const CVector &va, const CVector &vb, const CVector &vc);
|
||||
void Set(const CompressedVector *v, CColTriangle &tri) { Set(v[tri.a].Get(), v[tri.b].Get(), v[tri.c].Get()); }
|
||||
void GetNormal(CVector &n) const { n.x = normal.x/4096.0f; n.y = normal.y/4096.0f; n.z = normal.z/4096.0f; }
|
||||
float CalcPoint(const CVector &v) const { CVector n; GetNormal(n); return DotProduct(n, v) - dist/128.0f; };
|
||||
#ifdef GTA_PS2
|
||||
void Unpack(uint128 &qword) const {
|
||||
__asm__ volatile (
|
||||
"lh $8, 0(%1)\n"
|
||||
"lh $9, 2(%1)\n"
|
||||
"lh $10, 4(%1)\n"
|
||||
"lh $11, 6(%1)\n"
|
||||
"pextlw $10, $8\n"
|
||||
"pextlw $11, $9\n"
|
||||
"pextlw $2, $11, $10\n"
|
||||
"sq $2, %0\n"
|
||||
: "=m" (qword)
|
||||
: "r" (this)
|
||||
: "$8", "$9", "$10", "$11", "$2"
|
||||
);
|
||||
}
|
||||
#else
|
||||
void Unpack(int32 *qword) const {
|
||||
qword[0] = normal.x;
|
||||
qword[1] = normal.y;
|
||||
qword[2] = normal.z;
|
||||
qword[3] = dist;
|
||||
}
|
||||
#endif
|
||||
#else
|
||||
CVector normal;
|
||||
float dist;
|
||||
uint8 dir;
|
||||
|
@ -77,6 +137,7 @@ struct CColTrianglePlane
|
|||
void Set(const CompressedVector *v, CColTriangle &tri) { Set(v[tri.a].Get(), v[tri.b].Get(), v[tri.c].Get()); }
|
||||
void GetNormal(CVector &n) const { n = normal; }
|
||||
float CalcPoint(const CVector &v) const { return DotProduct(normal, v) - dist; };
|
||||
#endif
|
||||
};
|
||||
|
||||
struct CColPoint
|
||||
|
@ -91,11 +152,29 @@ struct CColPoint
|
|||
uint8 surfaceB;
|
||||
uint8 pieceB;
|
||||
float depth;
|
||||
|
||||
void Set(float depth, uint8 surfA, uint8 pieceA, uint8 surfB, uint8 pieceB) {
|
||||
this->depth = depth;
|
||||
this->surfaceA = surfA;
|
||||
this->pieceA = pieceA;
|
||||
this->surfaceB = surfB;
|
||||
this->pieceB = pieceB;
|
||||
}
|
||||
void Set(uint8 surfA, uint8 pieceA, uint8 surfB, uint8 pieceB) {
|
||||
this->surfaceA = surfA;
|
||||
this->pieceA = pieceA;
|
||||
this->surfaceB = surfB;
|
||||
this->pieceB = pieceB;
|
||||
}
|
||||
};
|
||||
|
||||
struct CStoredCollPoly
|
||||
{
|
||||
#ifdef VU_COLLISION
|
||||
CVuVector verts[3];
|
||||
#else
|
||||
CVector verts[3];
|
||||
#endif
|
||||
bool valid;
|
||||
};
|
||||
|
||||
|
|
|
@ -60,6 +60,11 @@ IsSeeThrough(uint8 surfType)
|
|||
switch(surfType)
|
||||
case SURFACE_GLASS:
|
||||
case SURFACE_TRANSPARENT_CLOTH:
|
||||
#if defined(FIX_BUGS) || defined(GTA_PS2)
|
||||
case SURFACE_METAL_CHAIN_FENCE:
|
||||
case SURFACE_TRANSPARENT_STONE:
|
||||
case SURFACE_SCAFFOLD_POLE:
|
||||
#endif
|
||||
return true;
|
||||
return false;
|
||||
}
|
||||
|
|
|
@ -89,6 +89,16 @@ typedef uint16_t wchar;
|
|||
#include <rpskin.h>
|
||||
#endif
|
||||
|
||||
#ifdef __GNUC__
|
||||
#define TYPEALIGN(n) __attribute__ ((aligned (n)))
|
||||
#else
|
||||
#ifdef _MSC_VER
|
||||
#define TYPEALIGN(n) __declspec(align(n))
|
||||
#else
|
||||
#define TYPEALIGN(n) // unknown compiler...ignore
|
||||
#endif
|
||||
#endif
|
||||
|
||||
#define ALIGNPTR(p) (void*)((((uintptr)(void*)p) + sizeof(void*)-1) & ~(sizeof(void*)-1))
|
||||
|
||||
// PDP-10 like byte functions
|
||||
|
|
|
@ -158,7 +158,7 @@ enum Config {
|
|||
#if defined GTA_PS2
|
||||
# define GTA_PS2_STUFF
|
||||
# define RANDOMSPLASH
|
||||
# define COMPRESSED_COL_VECTORS
|
||||
# define VU_COLLISION
|
||||
#elif defined GTA_PC
|
||||
# define GTA3_1_1_PATCH
|
||||
//# define GTA3_STEAM_PATCH
|
||||
|
@ -170,6 +170,10 @@ enum Config {
|
|||
#elif defined GTA_XBOX
|
||||
#endif
|
||||
|
||||
#ifdef VU_COLLISION
|
||||
#define COMPRESSED_COL_VECTORS // current need compressed vectors in this code
|
||||
#endif
|
||||
|
||||
#ifdef MASTER
|
||||
// only in master builds
|
||||
#else
|
||||
|
|
21
src/core/vu0Collision.dsm
Normal file
21
src/core/vu0Collision.dsm
Normal file
|
@ -0,0 +1,21 @@
|
|||
.align 4
|
||||
.global Vu0CollisionDmaTag
|
||||
Vu0CollisionDmaTag:
|
||||
DMAcnt *
|
||||
MPG 0, *
|
||||
.vu
|
||||
.include "vu0Collision_1.s"
|
||||
.EndMPG
|
||||
.EndDmaData
|
||||
DMAend
|
||||
|
||||
.global Vu0Collision2DmaTag
|
||||
Vu0Collision2DmaTag:
|
||||
DMAcnt *
|
||||
MPG 0, *
|
||||
.vu
|
||||
.include "vu0Collision_2.s"
|
||||
.EndMPG
|
||||
.EndDmaData
|
||||
DMAend
|
||||
.end
|
610
src/core/vu0Collision_1.s
Normal file
610
src/core/vu0Collision_1.s
Normal file
|
@ -0,0 +1,610 @@
|
|||
QuitAndFail:
|
||||
NOP[E] IADDIU VI01, VI00, 0
|
||||
NOP NOP
|
||||
|
||||
|
||||
QuitAndSucceed:
|
||||
NOP[E] IADDIU VI01, VI00, 1
|
||||
NOP NOP
|
||||
|
||||
|
||||
; 20 -- unused
|
||||
; VF12, VF13 xyz: sphere centers
|
||||
; VF14, VF15 x: sphere radii
|
||||
; out:
|
||||
; VI01: set when collision
|
||||
; VF01: supposed to be intersection point?
|
||||
; VF02: normal (pointing towards s1, not normalized)
|
||||
.globl Vu0SphereToSphereCollision
|
||||
Vu0SphereToSphereCollision:
|
||||
SUB.xyz VF02, VF13, VF12 NOP ; dist of centers
|
||||
ADD.x VF04, VF14, VF15 NOP ; s = sum of radii
|
||||
MUL.xyzw VF03, VF02, VF02 NOP ;
|
||||
MUL.x VF04, VF04, VF04 DIV Q, VF14x, VF04x ; square s
|
||||
NOP NOP ;
|
||||
NOP NOP ;
|
||||
MULAx.w ACC, VF00, VF03 NOP ;
|
||||
MADDAy.w ACC, VF00, VF03 NOP ;
|
||||
MADDz.w VF03, VF00, VF03 NOP ; d = DistSq of centers
|
||||
NOP NOP ;
|
||||
MULAw.xyz ACC, VF12, VF00 NOP ;
|
||||
MADDq.xyz VF01, VF02, Q NOP ; intersection, but wrong
|
||||
CLIPw.xyz VF04, VF03 NOP ; compare s and d
|
||||
SUB.xyz VF02, VF00, VF02 NOP ; compute normal
|
||||
NOP NOP ;
|
||||
NOP NOP ;
|
||||
NOP FCAND VI01, 0x3 ; 0x2 cannot be set here
|
||||
NOP[E] NOP ;
|
||||
NOP NOP ;
|
||||
|
||||
|
||||
; B8 -- unused
|
||||
; VF12:
|
||||
; VF13: radius
|
||||
; VF14:
|
||||
; VF15: box dimensions (?)
|
||||
.globl Vu0SphereToAABBCollision
|
||||
Vu0SphereToAABBCollision:
|
||||
SUB.xyz VF03, VF12, VF14 LOI 0.5
|
||||
MULi.xyz VF15, VF15, I NOP
|
||||
MUL.x VF13, VF13, VF13 NOP
|
||||
SUB.xyz VF04, VF03, VF15 NOP
|
||||
ADD.xyz VF05, VF03, VF15 MR32.xyzw VF16, VF15
|
||||
CLIPw.xyz VF03, VF16 MR32.xyzw VF17, VF16
|
||||
MUL.xyz VF04, VF04, VF04 NOP
|
||||
MUL.xyz VF05, VF05, VF05 NOP
|
||||
CLIPw.xyz VF03, VF17 MR32.xyzw VF16, VF17
|
||||
NOP FCAND VI01, 0x1
|
||||
MINI.xyz VF04, VF04, VF05 MFIR.x VF09, VI01
|
||||
NOP NOP
|
||||
CLIPw.xyz VF03, VF16 FCAND VI01, 0x4
|
||||
NOP MFIR.y VF09, VI01
|
||||
NOP NOP
|
||||
MULAx.w ACC, VF00, VF00 NOP
|
||||
ADD.xyz VF01, VF00, VF03 FCAND VI01, 0x10
|
||||
NOP MFIR.z VF09, VI01
|
||||
NOP LOI 2
|
||||
NOP FCAND VI01, 0x30
|
||||
SUBAw.xyz ACC, VF00, VF00 IADD VI04, VI00, VI01
|
||||
ITOF0.xyz VF09, VF09 FCAND VI01, 0x300
|
||||
NOP IADD VI03, VI00, VI01
|
||||
NOP FCAND VI01, 0x3000
|
||||
NOP IADD VI02, VI00, VI01
|
||||
MADDi.xyzw VF09, VF09, I NOP
|
||||
NOP IBEQ VI04, VI00, IgnoreZValue
|
||||
NOP NOP
|
||||
MADDAz.w ACC, VF00, VF04 NOP
|
||||
MUL.z VF01, VF09, VF15 NOP
|
||||
IgnoreZValue:
|
||||
NOP IBEQ VI03, VI00, IgnoreYValue
|
||||
NOP NOP
|
||||
MADDAy.w ACC, VF00, VF04 NOP
|
||||
MUL.y VF01, VF09, VF15 NOP
|
||||
IgnoreYValue:
|
||||
NOP IBEQ VI02, VI00, IgnoreXValue
|
||||
NOP NOP
|
||||
MADDAx.w ACC, VF00, VF04 NOP
|
||||
MUL.x VF01, VF09, VF15 NOP
|
||||
IgnoreXValue:
|
||||
MADDx.w VF06, VF00, VF00 NOP
|
||||
SUB.xyz VF02, VF03, VF01 NOP
|
||||
ADD.xyz VF01, VF01, VF14 NOP
|
||||
MULx.w VF01, VF00, VF00 NOP
|
||||
CLIPw.xyz VF13, VF06 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x1
|
||||
QuitMicrocode:
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
|
||||
|
||||
; 240
|
||||
.globl Vu0LineToSphereCollision
|
||||
Vu0LineToSphereCollision:
|
||||
SUB.xyzw VF01, VF13, VF12 NOP
|
||||
SUB.xyzw VF02, VF14, VF12 NOP
|
||||
MUL.xyz VF03, VF01, VF02 NOP
|
||||
MUL.xyz VF04, VF01, VF01 NOP
|
||||
MUL.x VF15, VF15, VF15 NOP
|
||||
MUL.xyz VF02, VF02, VF02 NOP
|
||||
MULAx.w ACC, VF00, VF03 NOP
|
||||
MADDAy.w ACC, VF00, VF03 NOP
|
||||
MADDz.w VF03, VF00, VF03 NOP
|
||||
MULAx.w ACC, VF00, VF04 NOP
|
||||
MADDAy.w ACC, VF00, VF04 NOP
|
||||
MADDz.w VF01, VF00, VF04 NOP
|
||||
MULAx.w ACC, VF00, VF02 NOP
|
||||
MADDAy.w ACC, VF00, VF02 NOP
|
||||
MADDz.w VF02, VF00, VF02 NOP
|
||||
MULA.w ACC, VF03, VF03 NOP
|
||||
MADDAx.w ACC, VF01, VF15 NOP
|
||||
MSUB.w VF05, VF01, VF02 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP IADDIU VI02, VI00, 0x10
|
||||
NOP FMAND VI01, VI02
|
||||
NOP IBNE VI01, VI00, QuitAndFail
|
||||
NOP NOP
|
||||
CLIPw.xyz VF15, VF02 SQRT Q, VF05w
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x1
|
||||
NOP IBNE VI00, VI01, LineStartInsideSphere
|
||||
NOP NOP
|
||||
SUBq.w VF05, VF03, Q NOP
|
||||
SUB.w VF05, VF05, VF01 DIV Q, VF05w, VF01w
|
||||
NOP FMAND VI01, VI02
|
||||
NOP IBNE VI01, VI00, QuitAndFail
|
||||
NOP NOP
|
||||
NOP FMAND VI01, VI02
|
||||
NOP IBEQ VI01, VI00, QuitAndFail
|
||||
NOP NOP
|
||||
ADDA.xyz ACC, VF12, VF00 NOP
|
||||
MADDq.xyz VF01, VF01, Q NOP
|
||||
MULx.w VF01, VF00, VF00 NOP
|
||||
SUB.xyz VF02, VF01, VF14 NOP
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
LineStartInsideSphere:
|
||||
NOP MOVE.xyzw VF01, VF12
|
||||
NOP[E] IADDIU VI01, VI00, 0x1
|
||||
NOP NOP
|
||||
|
||||
|
||||
; 3C0
|
||||
.globl Vu0LineToAABBCollision
|
||||
Vu0LineToAABBCollision:
|
||||
SUB.xyzw VF08, VF13, VF12 LOI 0.5
|
||||
MULi.xyz VF15, VF15, I IADDIU VI08, VI00, 0x0
|
||||
SUB.xyzw VF12, VF12, VF14 NOP
|
||||
SUB.xyzw VF13, VF13, VF14 NOP
|
||||
NOP DIV Q, VF00w, VF08x
|
||||
NOP MR32.xyzw VF03, VF15
|
||||
SUB.xyz VF06, VF15, VF12 NOP
|
||||
ADD.xyz VF07, VF15, VF12 NOP
|
||||
NOP NOP
|
||||
CLIPw.xyz VF12, VF03 MR32.xyzw VF04, VF03
|
||||
NOP NOP
|
||||
ADDq.x VF09, VF00, Q DIV Q, VF00w, VF08y
|
||||
NOP NOP
|
||||
CLIPw.xyz VF12, VF04 MR32.xyzw VF05, VF04
|
||||
SUB.xyz VF07, VF00, VF07 IADDIU VI06, VI00, 0xCC
|
||||
NOP IADDIU VI07, VI00, 0x30
|
||||
NOP NOP
|
||||
CLIPw.xyz VF12, VF05 FCGET VI02
|
||||
NOP IAND VI02, VI02, VI06
|
||||
ADDq.y VF09, VF00, Q DIV Q, VF00w, VF08z
|
||||
SUB.xyz VF10, VF00, VF10 NOP
|
||||
CLIPw.xyz VF13, VF03 FCGET VI03
|
||||
CLIPw.xyz VF13, VF04 IAND VI03, VI03, VI07
|
||||
CLIPw.xyz VF13, VF05 FCAND VI01, 0x3330
|
||||
NOP IBEQ VI01, VI00, StartPointInsideAABB
|
||||
NOP NOP
|
||||
ADDq.z VF09, VF00, Q FCGET VI04
|
||||
NOP FCGET VI05
|
||||
NOP IAND VI04, VI04, VI06
|
||||
NOP IAND VI05, VI05, VI07
|
||||
MULx.xyz VF17, VF08, VF09 NOP
|
||||
MULy.xyz VF18, VF08, VF09 IADDIU VI07, VI00, 0x80
|
||||
MULz.xyz VF19, VF08, VF09 IAND VI06, VI02, VI07
|
||||
MUL.w VF10, VF00, VF00 IAND VI07, VI04, VI07
|
||||
NOP NOP
|
||||
NOP IBEQ VI06, VI07, CheckMaxXSide
|
||||
NOP NOP
|
||||
MULAx.xyz ACC, VF17, VF07 NOP
|
||||
MADDw.xyz VF16, VF12, VF00 NOP
|
||||
MUL.x VF10, VF07, VF09 NOP
|
||||
CLIPw.xyz VF16, VF04 NOP
|
||||
CLIPw.xyz VF16, VF05 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x330
|
||||
NOP IBNE VI01, VI00, CheckMaxXSide
|
||||
NOP NOP
|
||||
MULx.w VF10, VF00, VF10 IADDIU VI08, VI00, 0x1
|
||||
ADD.yz VF02, VF00, VF00 MOVE.xyzw VF01, VF16
|
||||
SUBw.x VF02, VF00, VF00 NOP
|
||||
CheckMaxXSide:
|
||||
MULAx.xyz ACC, VF17, VF06 IADDIU VI07, VI00, 0x40
|
||||
MADDw.xyz VF16, VF12, VF00 IAND VI06, VI02, VI07
|
||||
MUL.x VF10, VF06, VF09 IAND VI07, VI04, VI07
|
||||
NOP NOP
|
||||
NOP IBEQ VI06, VI07, CheckMinYSide
|
||||
NOP NOP
|
||||
CLIPw.xyz VF16, VF04 NOP
|
||||
CLIPw.xyz VF16, VF05 NOP
|
||||
CLIPw.xyz VF10, VF10 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0xCC03
|
||||
NOP IBNE VI01, VI00, CheckMinYSide
|
||||
NOP NOP
|
||||
MULx.w VF10, VF00, VF10 IADDIU VI08, VI00, 0x1
|
||||
ADD.yz VF02, VF00, VF00 MOVE.xyzw VF01, VF16
|
||||
ADDw.x VF02, VF00, VF00 NOP
|
||||
CheckMinYSide:
|
||||
MULAy.xyz ACC, VF18, VF07 IADDIU VI07, VI00, 0x8
|
||||
MADDw.xyz VF16, VF12, VF00 IAND VI06, VI02, VI07
|
||||
MUL.y VF10, VF07, VF09 IAND VI07, VI04, VI07
|
||||
NOP NOP
|
||||
NOP IBEQ VI06, VI07, CheckMaxYSide
|
||||
NOP NOP
|
||||
CLIPw.xyz VF16, VF03 NOP
|
||||
CLIPw.xyz VF16, VF05 NOP
|
||||
CLIPw.xyz VF10, VF10 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3C0C
|
||||
NOP IBNE VI01, VI00, CheckMaxYSide
|
||||
NOP NOP
|
||||
MULy.w VF10, VF00, VF10 IADDIU VI08, VI00, 0x1
|
||||
ADD.xz VF02, VF00, VF00 MOVE.xyzw VF01, VF16
|
||||
SUBw.y VF02, VF00, VF00 NOP
|
||||
CheckMaxYSide:
|
||||
MULAy.xyz ACC, VF18, VF06 IADDIU VI07, VI00, 0x4
|
||||
MADDw.xyz VF16, VF12, VF00 IAND VI06, VI02, VI07
|
||||
MUL.y VF10, VF06, VF09 IAND VI07, VI04, VI07
|
||||
NOP NOP
|
||||
NOP IBEQ VI06, VI07, CheckMinZSide
|
||||
NOP NOP
|
||||
CLIPw.xyz VF16, VF03 NOP
|
||||
CLIPw.xyz VF16, VF05 NOP
|
||||
CLIPw.xyz VF10, VF10 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3C0C
|
||||
NOP IBNE VI01, VI00, CheckMinZSide
|
||||
NOP NOP
|
||||
MULy.w VF10, VF00, VF10 IADDIU VI08, VI00, 0x1
|
||||
ADD.xz VF02, VF00, VF00 MOVE.xyzw VF01, VF16
|
||||
ADDw.y VF02, VF00, VF00 NOP
|
||||
CheckMinZSide:
|
||||
MULAz.xyz ACC, VF19, VF07 IADDIU VI07, VI00, 0x20
|
||||
MADDw.xyz VF16, VF12, VF00 IAND VI06, VI03, VI07
|
||||
MUL.z VF10, VF07, VF09 IAND VI07, VI05, VI07
|
||||
NOP NOP
|
||||
NOP IBEQ VI06, VI07, CheckMaxZSide
|
||||
NOP NOP
|
||||
CLIPw.xyz VF16, VF03 NOP
|
||||
CLIPw.xyz VF16, VF04 NOP
|
||||
CLIPw.xyz VF10, VF10 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3330
|
||||
NOP IBNE VI01, VI00, CheckMaxZSide
|
||||
NOP NOP
|
||||
MULz.w VF10, VF00, VF10 IADDIU VI08, VI00, 0x1
|
||||
ADD.xy VF02, VF00, VF00 MOVE.xyzw VF01, VF16
|
||||
SUBw.z VF02, VF00, VF00 NOP
|
||||
CheckMaxZSide:
|
||||
MULAz.xyz ACC, VF19, VF06 IADDIU VI07, VI00, 0x10
|
||||
MADDw.xyz VF16, VF12, VF00 IAND VI06, VI03, VI07
|
||||
MUL.z VF10, VF06, VF09 IAND VI07, VI05, VI07
|
||||
NOP NOP
|
||||
NOP IBEQ VI06, VI07, DoneAllChecks
|
||||
NOP NOP
|
||||
CLIPw.xyz VF16, VF03 NOP
|
||||
CLIPw.xyz VF16, VF04 NOP
|
||||
CLIPw.xyz VF10, VF10 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3330
|
||||
NOP IBNE VI01, VI00, DoneAllChecks
|
||||
NOP NOP
|
||||
MULz.w VF10, VF00, VF10 IADDIU VI08, VI00, 0x1
|
||||
ADD.xy VF02, VF00, VF00 MOVE.xyzw VF01, VF16
|
||||
ADDw.z VF02, VF00, VF00 NOP
|
||||
DoneAllChecks:
|
||||
ADD.xyz VF01, VF01, VF14 IADD VI01, VI00, VI08
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
StartPointInsideAABB:
|
||||
ADD.xyz VF01, VF12, VF14 WAITQ
|
||||
NOP IADDIU VI01, VI00, 0x1
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
|
||||
|
||||
; 860
|
||||
.globl Vu0LineToTriangleCollisionCompressedStart
|
||||
Vu0LineToTriangleCollisionCompressedStart:
|
||||
ITOF0.xyzw VF17, VF17 LOI 0.000244140625 ; 1.0/4096.0
|
||||
ITOF0.xyzw VF14, VF14 NOP
|
||||
ITOF0.xyzw VF15, VF15 NOP
|
||||
ITOF0.xyzw VF16, VF16 NOP
|
||||
MULi.xyz VF17, VF17, I LOI 0.0078125 ; 1.0/128.0
|
||||
MULi.w VF17, VF17, I NOP
|
||||
MULi.xyzw VF14, VF14, I NOP
|
||||
MULi.xyzw VF15, VF15, I NOP
|
||||
MULi.xyzw VF16, VF16, I NOP
|
||||
; fall through
|
||||
|
||||
; 8A8
|
||||
; VF12: point0
|
||||
; VF13: point1
|
||||
; VF14-16: verts
|
||||
; VF17: plane
|
||||
; out:
|
||||
; VF01: intersection point
|
||||
; VF02: triangle normal
|
||||
; VF03 x: intersection parameter
|
||||
.globl Vu0LineToTriangleCollisionStart
|
||||
Vu0LineToTriangleCollisionStart:
|
||||
MUL.xyz VF10, VF17, VF12 LOI 0.5
|
||||
MUL.xyz VF11, VF17, VF13 NOP
|
||||
SUB.xyz VF02, VF13, VF12 NOP ; line dist
|
||||
ADD.xyz VF17, VF17, VF00 NOP
|
||||
MULi.w VF03, VF00, I NOP
|
||||
MULAx.w ACC, VF00, VF10 NOP
|
||||
MADDAy.w ACC, VF00, VF10 IADDIU VI06, VI00, 0xE0
|
||||
MADDz.w VF10, VF00, VF10 FMAND VI05, VI06 ; -- normal sign flags, unused
|
||||
MULAx.w ACC, VF00, VF11 NOP
|
||||
MADDAy.w ACC, VF00, VF11 NOP
|
||||
MADDz.w VF11, VF00, VF11 NOP
|
||||
SUB.w VF09, VF17, VF10 NOP ; plane-pos 0
|
||||
CLIPw.xyz VF17, VF03 NOP ; compare normal against 0.5 to figure out which in which dimension to compare
|
||||
NOP IADDIU VI02, VI00, 0x10 ; Sw flag
|
||||
SUBA.w ACC, VF17, VF11 NOP ; plane-pos 1
|
||||
SUB.w VF08, VF11, VF10 FMAND VI01, VI02
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FMAND VI02, VI02
|
||||
NOP IBEQ VI01, VI02, QuitAndFail ; if on same side, no collision
|
||||
NOP NOP
|
||||
NOP DIV Q, VF09w, VF08w ; parameter of intersection
|
||||
NOP FCAND VI01, 0x3 ; check x direction
|
||||
NOP IADDIU VI02, VI01, 0x7F
|
||||
NOP IADDIU VI06, VI00, 0x80
|
||||
NOP IAND VI02, VI02, VI06 ; Sx flag
|
||||
NOP FCAND VI01, 0xC ; check y direction
|
||||
NOP IADDIU VI03, VI01, 0x3F
|
||||
MULAw.xyz ACC, VF12, VF00 IADDIU VI06, VI00, 0x40
|
||||
MADDq.xyz VF01, VF02, Q IAND VI03, VI03, VI06 ; point of intersection -- Sy flag
|
||||
MULx.w VF01, VF00, VF00 FCAND VI01, 0x30 ; -- check z direction
|
||||
ADDq.x VF03, VF00, Q IADDIU VI04, VI01, 0x1F ; output parameter
|
||||
SUB.xyz VF05, VF15, VF14 IADDIU VI06, VI00, 0x20 ; edge vectors
|
||||
SUB.xyz VF08, VF01, VF14 IAND VI04, VI04, VI06 ; edge vectors -- Sz flag
|
||||
SUB.xyz VF06, VF16, VF15 IADD VI06, VI02, VI03 ; edge vectors
|
||||
SUB.xyz VF09, VF01, VF15 IADD VI06, VI06, VI04 ; edge vectors -- combine flags
|
||||
SUB.xyz VF07, VF14, VF16 NOP ; edge vectors
|
||||
SUB.xyz VF10, VF01, VF16 NOP ; edge vectors
|
||||
OPMULA.xyz ACC, VF08, VF05 NOP
|
||||
OPMSUB.xyz VF18, VF05, VF08 NOP ; cross1
|
||||
OPMULA.xyz ACC, VF09, VF06 NOP
|
||||
OPMSUB.xyz VF19, VF06, VF09 NOP ; cross2
|
||||
OPMULA.xyz ACC, VF10, VF07 NOP
|
||||
OPMSUB.xyz VF20, VF07, VF10 FMAND VI02, VI06 ; cross3
|
||||
NOP NOP
|
||||
NOP FMAND VI03, VI06
|
||||
NOP NOP
|
||||
NOP FMAND VI04, VI06
|
||||
NOP NOP
|
||||
NOP IBNE VI03, VI02, QuitAndFail ; point has to lie on the same side of all edges (i.e. inside)
|
||||
NOP NOP
|
||||
NOP IBNE VI04, VI02, QuitAndFail
|
||||
NOP NOP
|
||||
MULw.xyz VF02, VF17, VF00 IADDIU VI01, VI00, 0x1 ; success
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
|
||||
|
||||
; A68
|
||||
; VF12: center
|
||||
; VF14: line origin
|
||||
; VF15: line vector to other point
|
||||
; out: VF16 xyz: nearest point on line; w: distance to that point
|
||||
DistanceBetweenSphereAndLine:
|
||||
SUB.xyz VF20, VF12, VF14 NOP
|
||||
MUL.xyz VF21, VF15, VF15 NOP
|
||||
ADDA.xyz ACC, VF14, VF15 NOP
|
||||
MSUBw.xyz VF25, VF12, VF00 NOP ; VF25 = VF12 - (VF14+VF15)
|
||||
MUL.xyz VF22, VF20, VF20 NOP
|
||||
MUL.xyz VF23, VF20, VF15 NOP
|
||||
MULAx.w ACC, VF00, VF21 NOP
|
||||
MADDAy.w ACC, VF00, VF21 NOP
|
||||
MADDz.w VF21, VF00, VF21 NOP ; MagSq VF15 (line length)
|
||||
MULAx.w ACC, VF00, VF23 NOP
|
||||
MADDAy.w ACC, VF00, VF23 NOP
|
||||
MADDz.w VF23, VF00, VF23 NOP ; dot(VF12-VF14, VF15)
|
||||
MULAx.w ACC, VF00, VF22 NOP
|
||||
MADDAy.w ACC, VF00, VF22 NOP
|
||||
MADDz.w VF22, VF00, VF22 IADDIU VI08, VI00, 0x10 ; MagSq VF12-VF14 -- Sw bit
|
||||
MUL.xyz VF25, VF25, VF25 FMAND VI08, VI08
|
||||
NOP DIV Q, VF23w, VF21w
|
||||
NOP IBNE VI00, VI08, NegativeRatio
|
||||
NOP NOP
|
||||
ADDA.xyz ACC, VF00, VF14 NOP
|
||||
MADDq.xyz VF16, VF15, Q WAITQ ; nearest point on infinte line
|
||||
ADDq.x VF24, VF00, Q NOP ; ratio
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
SUB.xyz VF26, VF16, VF12 NOP
|
||||
CLIPw.xyz VF24, VF00 NOP ; compare ratio to 1.0
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
MUL.xyz VF26, VF26, VF26 NOP
|
||||
NOP FCAND VI01, 0x1
|
||||
NOP IBNE VI00, VI01, RatioGreaterThanOne
|
||||
NOP NOP
|
||||
MULAx.w ACC, VF00, VF26 NOP
|
||||
MADDAy.w ACC, VF00, VF26 NOP
|
||||
MADDz.w VF16, VF00, VF26 NOP ; distance
|
||||
NOP JR VI15
|
||||
NOP NOP
|
||||
NegativeRatio:
|
||||
ADD.xyz VF16, VF00, VF14 NOP ; return line origin
|
||||
MUL.w VF16, VF00, VF22 NOP ; and DistSq to it
|
||||
NOP JR VI15
|
||||
NOP NOP
|
||||
RatioGreaterThanOne:
|
||||
MULAx.w ACC, VF00, VF25 NOP
|
||||
MADDAy.w ACC, VF00, VF25 NOP
|
||||
MADDz.w VF16, VF00, VF25 NOP
|
||||
ADD.xyz VF16, VF14, VF15 NOP ; return toerh line point
|
||||
NOP JR VI15
|
||||
NOP NOP
|
||||
|
||||
|
||||
; BE0
|
||||
.globl Vu0SphereToTriangleCollisionCompressedStart
|
||||
Vu0SphereToTriangleCollisionCompressedStart:
|
||||
ITOF0.xyzw VF17, VF17 LOI 0.000244140625 ; 1.0/4096.0
|
||||
ITOF0.xyzw VF14, VF14 NOP
|
||||
ITOF0.xyzw VF15, VF15 NOP
|
||||
ITOF0.xyzw VF16, VF16 NOP
|
||||
MULi.xyz VF17, VF17, I LOI 0.0078125 ; 1.0/128.0
|
||||
MULi.w VF17, VF17, I NOP
|
||||
MULi.xyzw VF14, VF14, I NOP
|
||||
MULi.xyzw VF15, VF15, I NOP
|
||||
MULi.xyzw VF16, VF16, I NOP
|
||||
; fall through
|
||||
|
||||
; C28
|
||||
; VF12: sphere
|
||||
; VF14-16: verts
|
||||
; VF17: plane
|
||||
; out:
|
||||
; VF01: intersection point
|
||||
; VF02: triangle normal
|
||||
; VF03 x: intersection parameter
|
||||
.globl Vu0SphereToTriangleCollisionStart
|
||||
Vu0SphereToTriangleCollisionStart:
|
||||
MUL.xyz VF02, VF12, VF17 LOI 0.1
|
||||
ADD.xyz VF17, VF17, VF00 NOP
|
||||
ADDw.x VF13, VF00, VF12 NOP
|
||||
NOP NOP
|
||||
MULAx.w ACC, VF00, VF02 IADDIU VI06, VI00, 0xE0
|
||||
MADDAy.w ACC, VF00, VF02 FMAND VI05, VI06 ; normal sign flags
|
||||
MADDAz.w ACC, VF00, VF02 NOP
|
||||
MSUB.w VF02, VF00, VF17 NOP ; center plane pos
|
||||
MULi.w VF03, VF00, I MOVE.xyzw VF04, VF03
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
CLIPw.xyz VF13, VF02 NOP ; compare dist and radius
|
||||
CLIPw.xyz VF17, VF03 NOP
|
||||
MULAw.xyz ACC, VF12, VF00 IADDIU VI07, VI00, 0x0 ; -- clear test case
|
||||
MSUBw.xyz VF01, VF17, VF02 NOP
|
||||
MULx.w VF01, VF00, VF00 FCAND VI01, 0x3 ; projected center on plane
|
||||
ABS.w VF02, VF02 IBEQ VI00, VI01, QuitAndFail ; no intersection
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3 ; -- check x direction
|
||||
SUB.xyz VF02, VF12, VF01 IADDIU VI02, VI01, 0x7F
|
||||
NOP IADDIU VI06, VI00, 0x80
|
||||
SUB.xyz VF05, VF15, VF14 IAND VI02, VI02, VI06
|
||||
SUB.xyz VF08, VF01, VF14 FCAND VI01, 0xC ; -- check y direction
|
||||
SUB.xyz VF06, VF16, VF15 IADDIU VI03, VI01, 0x3F
|
||||
SUB.xyz VF09, VF01, VF15 IADDIU VI06, VI00, 0x40
|
||||
SUB.xyz VF07, VF14, VF16 IAND VI03, VI03, VI06
|
||||
SUB.xyz VF10, VF01, VF16 FCAND VI01, 0x30 ; -- check z direction
|
||||
MUL.xyz VF03, VF02, VF02 IADDIU VI04, VI01, 0x1F
|
||||
OPMULA.xyz ACC, VF08, VF05 IADDIU VI06, VI00, 0x20
|
||||
OPMSUB.xyz VF18, VF05, VF08 IAND VI04, VI04, VI06
|
||||
OPMULA.xyz ACC, VF09, VF06 NOP
|
||||
OPMSUB.xyz VF19, VF06, VF09 IADD VI06, VI02, VI03
|
||||
OPMULA.xyz ACC, VF10, VF07 IADD VI06, VI06, VI04 ; -- combine flags
|
||||
OPMSUB.xyz VF20, VF07, VF10 FMAND VI02, VI06 ; -- cross 1 flags
|
||||
MULAx.w ACC, VF00, VF03 IAND VI05, VI05, VI06
|
||||
MADDAy.w ACC, VF00, VF03 FMAND VI03, VI06 ; -- cross 2 flags
|
||||
MADDz.w VF03, VF00, VF03 IADDIU VI08, VI00, 0x3
|
||||
NOP FMAND VI04, VI06 ; -- cross 3 flags
|
||||
NOP NOP
|
||||
NOP IBNE VI02, VI05, CheckSide2
|
||||
NOP RSQRT Q, VF00w, VF03w
|
||||
ADD.xyz VF04, VF00, VF16 IADDIU VI07, VI07, 0x1 ; inside side 1
|
||||
CheckSide2:
|
||||
NOP IBNE VI03, VI05, CheckSide3
|
||||
NOP NOP
|
||||
ADD.xyz VF04, VF00, VF14 IADDIU VI07, VI07, 0x1 ; inside side 2
|
||||
CheckSide3:
|
||||
NOP IBNE VI04, VI05, FinishCheckingSides
|
||||
NOP NOP
|
||||
ADD.xyz VF04, VF00, VF15 IADDIU VI07, VI07, 0x1 ; inside side 3
|
||||
NOP NOP
|
||||
NOP IBEQ VI07, VI08, TotallyInsideTriangle
|
||||
NOP NOP
|
||||
FinishCheckingSides:
|
||||
MUL.x VF13, VF13, VF13 IADDIU VI08, VI00, 0x2
|
||||
MULq.xyz VF02, VF02, Q WAITQ
|
||||
NOP IBNE VI07, VI08, IntersectionOutsideTwoSides
|
||||
NOP NOP
|
||||
NOP IBEQ VI02, VI05, CheckDistanceSide2
|
||||
NOP NOP
|
||||
NOP MOVE.xyzw VF15, VF05
|
||||
NOP BAL VI15, DistanceBetweenSphereAndLine
|
||||
NOP NOP
|
||||
NOP B ProcessLineResult
|
||||
NOP NOP
|
||||
CheckDistanceSide2:
|
||||
NOP IBEQ VI03, VI05, CheckDistanceSide3
|
||||
NOP NOP
|
||||
NOP MOVE.xyzw VF14, VF15
|
||||
NOP MOVE.xyzw VF15, VF06
|
||||
NOP BAL VI15, DistanceBetweenSphereAndLine
|
||||
NOP NOP
|
||||
NOP B ProcessLineResult
|
||||
NOP NOP
|
||||
CheckDistanceSide3:
|
||||
NOP MOVE.xyzw VF14, VF16
|
||||
NOP MOVE.xyzw VF15, VF07
|
||||
NOP BAL VI15, DistanceBetweenSphereAndLine
|
||||
NOP NOP
|
||||
NOP B ProcessLineResult
|
||||
NOP NOP
|
||||
IntersectionOutsideTwoSides:
|
||||
SUB.xyz VF05, VF04, VF12 NOP
|
||||
ADD.xyz VF01, VF00, VF04 NOP ; col point
|
||||
SUB.xyz VF02, VF12, VF04 NOP
|
||||
NOP NOP
|
||||
MUL.xyz VF05, VF05, VF05 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
MULAx.w ACC, VF00, VF05 NOP
|
||||
MADDAy.w ACC, VF00, VF05 NOP
|
||||
MADDz.w VF05, VF00, VF05 NOP ; distSq to vertex
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
CLIPw.xyz VF13, VF05 SQRT Q, VF05w ; compare radiusSq and distSq
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x1
|
||||
ADDq.x VF03, VF00, Q WAITQ ; dist to vertex
|
||||
NOP IBEQ VI00, VI01, QuitAndFail ; too far
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP DIV Q, VF00w, VF03x
|
||||
MULq.xyz VF02, VF02, Q WAITQ ; col normal
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
TotallyInsideTriangle:
|
||||
ADDw.x VF03, VF00, VF02 WAITQ
|
||||
MULq.xyz VF02, VF02, Q NOP
|
||||
NOP[E] IADDIU VI01, VI00, 0x1
|
||||
NOP NOP
|
||||
ProcessLineResult:
|
||||
CLIPw.xyz VF13, VF16 SQRT Q, VF16w
|
||||
ADD.xyz VF01, VF00, VF16 NOP
|
||||
SUB.xyz VF02, VF12, VF16 NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x1
|
||||
ADDq.x VF03, VF00, Q WAITQ
|
||||
NOP IBEQ VI00, VI01, QuitAndFail
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP DIV Q, VF00w, VF03x
|
||||
MULq.xyz VF02, VF02, Q WAITQ
|
||||
NOP[E] NOP
|
||||
NOP NOP
|
||||
|
||||
EndOfMicrocode:
|
191
src/core/vu0Collision_2.s
Normal file
191
src/core/vu0Collision_2.s
Normal file
|
@ -0,0 +1,191 @@
|
|||
QuitAndFail2:
|
||||
NOP[E] IADDIU VI01, VI00, 0x0
|
||||
NOP NOP
|
||||
|
||||
|
||||
QuitAndSucceed2:
|
||||
NOP[E] IADDIU VI01, VI00, 0x1
|
||||
NOP NOP
|
||||
|
||||
|
||||
; 20
|
||||
GetBBVertices:
|
||||
MULw.xy VF02, VF01, VF00 NOP
|
||||
MUL.z VF02, VF01, VF11 NOP
|
||||
MULw.xz VF03, VF01, VF00 NOP
|
||||
MUL.y VF03, VF01, VF11 NOP
|
||||
MULw.x VF04, VF01, VF00 NOP
|
||||
MUL.yz VF04, VF01, VF11 NOP
|
||||
NOP JR VI15
|
||||
NOP NOP
|
||||
|
||||
|
||||
; 60
|
||||
Vu0OBBToOBBCollision:
|
||||
SUBw.xyz VF11, VF00, VF00 LOI 0.5
|
||||
MULi.xyz VF12, VF12, I NOP
|
||||
MULi.xyz VF13, VF13, I NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP MOVE.xyz VF01, VF12
|
||||
NOP BAL VI15, GetBBVertices
|
||||
NOP NOP
|
||||
MULAx.xyz ACC, VF14, VF01 NOP
|
||||
MADDAy.xyz ACC, VF15, VF01 NOP
|
||||
MADDz.xyz VF01, VF16, VF01 NOP
|
||||
MULAx.xyz ACC, VF14, VF02 NOP
|
||||
MADDAy.xyz ACC, VF15, VF02 NOP
|
||||
MADDz.xyz VF02, VF16, VF02 NOP
|
||||
MULAx.xyz ACC, VF14, VF03 NOP
|
||||
MADDAy.xyz ACC, VF15, VF03 NOP
|
||||
MADDz.xyz VF03, VF16, VF03 NOP
|
||||
MULAx.xyz ACC, VF14, VF04 NOP
|
||||
MADDAy.xyz ACC, VF15, VF04 NOP
|
||||
MADDz.xyz VF04, VF16, VF04 NOP
|
||||
ABS.xyz VF05, VF01 NOP
|
||||
ABS.xyz VF06, VF02 NOP
|
||||
ABS.xyz VF07, VF03 NOP
|
||||
ABS.xyz VF08, VF04 NOP
|
||||
NOP NOP
|
||||
MAX.xyz VF05, VF05, VF06 NOP
|
||||
NOP NOP
|
||||
MAX.xyz VF07, VF07, VF08 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
MAX.xyz VF05, VF05, VF07 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
ADD.xyz VF09, VF05, VF13 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
MULx.w VF05, VF00, VF09 NOP
|
||||
MULy.w VF06, VF00, VF09 NOP
|
||||
MULz.w VF07, VF00, VF09 NOP
|
||||
CLIPw.xyz VF17, VF05 NOP
|
||||
CLIPw.xyz VF17, VF06 NOP
|
||||
CLIPw.xyz VF17, VF07 MOVE.xyz VF01, VF13
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3330
|
||||
NOP IBNE VI01, VI00, QuitAndFail2
|
||||
NOP NOP
|
||||
NOP BAL VI15, GetBBVertices
|
||||
NOP NOP
|
||||
MULAx.xyz ACC, VF18, VF01 NOP
|
||||
MADDAy.xyz ACC, VF19, VF01 NOP
|
||||
MADDz.xyz VF01, VF20, VF01 NOP
|
||||
MULAx.xyz ACC, VF18, VF02 NOP
|
||||
MADDAy.xyz ACC, VF19, VF02 NOP
|
||||
MADDz.xyz VF02, VF20, VF02 NOP
|
||||
MULAx.xyz ACC, VF18, VF03 NOP
|
||||
MADDAy.xyz ACC, VF19, VF03 NOP
|
||||
MADDz.xyz VF03, VF20, VF03 NOP
|
||||
MULAx.xyz ACC, VF18, VF04 NOP
|
||||
MADDAy.xyz ACC, VF19, VF04 NOP
|
||||
MADDz.xyz VF04, VF20, VF04 NOP
|
||||
ABS.xyz VF05, VF01 NOP
|
||||
ABS.xyz VF06, VF02 NOP
|
||||
ABS.xyz VF07, VF03 NOP
|
||||
ABS.xyz VF08, VF04 NOP
|
||||
NOP NOP
|
||||
MAX.xyz VF05, VF05, VF06 NOP
|
||||
NOP NOP
|
||||
MAX.xyz VF07, VF07, VF08 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
MAX.xyz VF05, VF05, VF07 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
ADD.xyz VF09, VF05, VF12 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
MULx.w VF05, VF00, VF09 NOP
|
||||
MULy.w VF06, VF00, VF09 NOP
|
||||
MULz.w VF07, VF00, VF09 NOP
|
||||
CLIPw.xyz VF21, VF05 NOP
|
||||
CLIPw.xyz VF21, VF06 NOP
|
||||
CLIPw.xyz VF21, VF07 NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP NOP
|
||||
NOP FCAND VI01, 0x3330
|
||||
NOP IBNE VI01, VI00, QuitAndFail2
|
||||
NOP NOP
|
||||
SUB.xyz VF06, VF02, VF01 NOP
|
||||
SUB.xyz VF07, VF03, VF01 NOP
|
||||
ADD.xyz VF08, VF04, VF01 NOP
|
||||
ADD.x VF09, VF00, VF12 NOP
|
||||
ADD.yz VF09, VF00, VF00 NOP
|
||||
ADD.y VF10, VF00, VF12 NOP
|
||||
ADD.xz VF10, VF00, VF00 NOP
|
||||
ADD.z VF11, VF00, VF12 IADDI VI04, VI00, 0x0
|
||||
ADD.xy VF11, VF00, VF00 IADD VI02, VI00, VI00
|
||||
OPMULA.xyz ACC, VF06, VF09 NOP
|
||||
OPMSUB.xyz VF01, VF09, VF06 NOP
|
||||
OPMULA.xyz ACC, VF06, VF10 NOP
|
||||
OPMSUB.xyz VF02, VF10, VF06 NOP
|
||||
OPMULA.xyz ACC, VF06, VF11 NOP
|
||||
OPMSUB.xyz VF03, VF11, VF06 SQI.xyzw VF01, (VI02++)
|
||||
OPMULA.xyz ACC, VF07, VF09 NOP
|
||||
OPMSUB.xyz VF01, VF09, VF07 SQI.xyzw VF02, (VI02++)
|
||||
OPMULA.xyz ACC, VF07, VF10 NOP
|
||||
OPMSUB.xyz VF02, VF10, VF07 SQI.xyzw VF03, (VI02++)
|
||||
OPMULA.xyz ACC, VF07, VF11 NOP
|
||||
OPMSUB.xyz VF03, VF11, VF07 SQI.xyzw VF01, (VI02++)
|
||||
OPMULA.xyz ACC, VF08, VF09 NOP
|
||||
OPMSUB.xyz VF01, VF09, VF08 SQI.xyzw VF02, (VI02++)
|
||||
OPMULA.xyz ACC, VF08, VF10 NOP
|
||||
OPMSUB.xyz VF02, VF10, VF08 SQI.xyzw VF03, (VI02++)
|
||||
OPMULA.xyz ACC, VF08, VF11 LOI 0.5
|
||||
OPMSUB.xyz VF01, VF11, VF08 SQI.xyzw VF01, (VI02++)
|
||||
MULi.xyz VF06, VF06, I NOP
|
||||
MULi.xyz VF07, VF07, I SQI.xyzw VF02, (VI02++)
|
||||
MULi.xyz VF08, VF08, I NOP
|
||||
MUL.xyz VF02, VF21, VF01 NOP
|
||||
MUL.xyz VF03, VF12, VF01 NOP
|
||||
MUL.xyz VF09, VF06, VF01 NOP
|
||||
MUL.xyz VF10, VF07, VF01 NOP
|
||||
MUL.xyz VF11, VF08, VF01 NOP
|
||||
ABS.xyz VF03, VF03 NOP
|
||||
ADDy.x VF05, VF09, VF09 NOP
|
||||
ADDx.y VF05, VF10, VF10 NOP
|
||||
ADDx.z VF05, VF11, VF11 NOP
|
||||
NOP NOP
|
||||
EdgePairLoop:
|
||||
ADDz.x VF05, VF05, VF09 NOP
|
||||
ADDz.y VF05, VF05, VF10 NOP
|
||||
ADDy.z VF05, VF05, VF11 NOP
|
||||
MULAx.w ACC, VF00, VF02 IADD VI03, VI02, VI00
|
||||
MADDAy.w ACC, VF00, VF02 LQD.xyzw VF01, (--VI02)
|
||||
MADDz.w VF02, VF00, VF02 NOP
|
||||
ABS.xyz VF05, VF05 NOP
|
||||
MULAx.w ACC, VF00, VF03 NOP
|
||||
MADDAy.w ACC, VF00, VF03 NOP
|
||||
MADDAz.w ACC, VF00, VF03 NOP
|
||||
MADDAx.w ACC, VF00, VF05 NOP
|
||||
MADDAy.w ACC, VF00, VF05 NOP
|
||||
MADDz.w VF03, VF00, VF05 NOP
|
||||
ADDw.x VF04, VF00, VF02 NOP
|
||||
MUL.xyz VF02, VF21, VF01 NOP
|
||||
MUL.xyz VF03, VF12, VF01 NOP
|
||||
MUL.xyz VF09, VF06, VF01 NOP
|
||||
CLIPw.xyz VF04, VF03 NOP
|
||||
MUL.xyz VF10, VF07, VF01 NOP
|
||||
MUL.xyz VF11, VF08, VF01 NOP
|
||||
ABS.xyz VF03, VF03 NOP
|
||||
ADDy.x VF05, VF09, VF09 FCAND VI01, 0x3
|
||||
ADDx.y VF05, VF10, VF10 IBNE VI01, VI00, QuitAndFail2
|
||||
ADDx.z VF05, VF11, VF11 NOP
|
||||
NOP IBNE VI03, VI00, EdgePairLoop
|
||||
NOP NOP
|
||||
NOP[E] IADDIU VI01, VI00, 0x1
|
||||
NOP NOP
|
||||
|
||||
EndOfMicrocode2:
|
|
@ -81,6 +81,7 @@ public:
|
|||
m_matrix.pos.z += rhs.m_matrix.pos.z;
|
||||
return *this;
|
||||
}
|
||||
CMatrix& operator*=(CMatrix const &rhs);
|
||||
|
||||
CVector &GetPosition(void){ return *(CVector*)&m_matrix.pos; }
|
||||
CVector &GetRight(void) { return *(CVector*)&m_matrix.right; }
|
||||
|
|
41
src/math/VuVector.h
Normal file
41
src/math/VuVector.h
Normal file
|
@ -0,0 +1,41 @@
|
|||
#pragma once
|
||||
|
||||
class TYPEALIGN(16) CVuVector : public CVector
|
||||
{
|
||||
public:
|
||||
float w;
|
||||
CVuVector(void) {}
|
||||
CVuVector(float x, float y, float z) : CVector(x, y, z) {}
|
||||
CVuVector(float x, float y, float z, float w) : CVector(x, y, z), w(w) {}
|
||||
CVuVector(const CVector &v) : CVector(v.x, v.y, v.z) {}
|
||||
#ifdef RWCORE_H
|
||||
CVuVector(const RwV3d &v) : CVector(v.x, v.y, v.z) {}
|
||||
|
||||
operator RwV3d (void) const {
|
||||
RwV3d vecRw = { this->x, this->y, this->z };
|
||||
return vecRw;
|
||||
}
|
||||
|
||||
operator RwV3d *(void) {
|
||||
return (RwV3d*)this;
|
||||
}
|
||||
#endif
|
||||
/*
|
||||
void Normalise(void) {
|
||||
float sq = MagnitudeSqr();
|
||||
// TODO: VU0 code
|
||||
if(sq > 0.0f){
|
||||
float invsqrt = RecipSqrt(sq);
|
||||
x *= invsqrt;
|
||||
y *= invsqrt;
|
||||
z *= invsqrt;
|
||||
}else
|
||||
x = 1.0f;
|
||||
}
|
||||
*/
|
||||
};
|
||||
|
||||
void TransformPoint(CVuVector &out, const CMatrix &mat, const CVuVector &in);
|
||||
void TransformPoint(CVuVector &out, const CMatrix &mat, const RwV3d &in);
|
||||
void TransformPoints(CVuVector *out, int n, const CMatrix &mat, const RwV3d *in, int stride);
|
||||
void TransformPoints(CVuVector *out, int n, const CMatrix &mat, const CVuVector *in);
|
|
@ -1,9 +1,124 @@
|
|||
#include "common.h"
|
||||
|
||||
#include "Quaternion.h"
|
||||
#include "VuVector.h"
|
||||
|
||||
// TODO: move more stuff into here
|
||||
|
||||
|
||||
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
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
CVector2D::Normalise(void)
|
||||
{
|
||||
|
@ -87,6 +202,7 @@ CMatrix::Reorthogonalise(void)
|
|||
CMatrix&
|
||||
Invert(const CMatrix &src, CMatrix &dst)
|
||||
{
|
||||
// TODO: VU0 code
|
||||
// GTA handles this as a raw 4x4 orthonormal matrix
|
||||
// and trashes the RW flags, let's not do that
|
||||
// actual copy of librw code:
|
||||
|
@ -117,6 +233,7 @@ Invert(const CMatrix &src, CMatrix &dst)
|
|||
CVector
|
||||
operator*(const CMatrix &mat, const CVector &vec)
|
||||
{
|
||||
// TODO: VU0 code
|
||||
return CVector(
|
||||
mat.m_matrix.right.x * vec.x + mat.m_matrix.up.x * vec.y + mat.m_matrix.at.x * vec.z + mat.m_matrix.pos.x,
|
||||
mat.m_matrix.right.y * vec.x + mat.m_matrix.up.y * vec.y + mat.m_matrix.at.y * vec.z + mat.m_matrix.pos.y,
|
||||
|
@ -126,6 +243,7 @@ operator*(const CMatrix &mat, const CVector &vec)
|
|||
CMatrix
|
||||
operator*(const CMatrix &m1, const CMatrix &m2)
|
||||
{
|
||||
// TODO: VU0 code
|
||||
CMatrix out;
|
||||
RwMatrix *dst = &out.m_matrix;
|
||||
const RwMatrix *src1 = &m1.m_matrix;
|
||||
|
@ -145,9 +263,18 @@ operator*(const CMatrix &m1, const CMatrix &m2)
|
|||
return out;
|
||||
}
|
||||
|
||||
CMatrix&
|
||||
CMatrix::operator*=(CMatrix const &rhs)
|
||||
{
|
||||
// TODO: VU0 code
|
||||
*this = *this * rhs;
|
||||
return *this;
|
||||
}
|
||||
|
||||
const CVector
|
||||
Multiply3x3(const CMatrix &mat, const CVector &vec)
|
||||
{
|
||||
// TODO: VU0 code
|
||||
return CVector(
|
||||
mat.m_matrix.right.x * vec.x + mat.m_matrix.up.x * vec.y + mat.m_matrix.at.x * vec.z,
|
||||
mat.m_matrix.right.y * vec.x + mat.m_matrix.up.y * vec.y + mat.m_matrix.at.y * vec.z,
|
||||
|
@ -179,6 +306,7 @@ CQuaternion::Slerp(const CQuaternion &q1, const CQuaternion &q2, float theta, fl
|
|||
w1 = Sin((1.0f - t) * theta) * invSin;
|
||||
w2 = Sin(t * theta) * invSin;
|
||||
}
|
||||
// TODO: VU0 code
|
||||
*this = w1*q1 + w2*q2;
|
||||
}
|
||||
}
|
||||
|
|
|
@ -1027,7 +1027,9 @@ CShadows::CastShadowEntity(CEntity *pEntity, float fStartX, float fStartY, floa
|
|||
CColTrianglePlane *pColTriPlanes = pCol->trianglePlanes;
|
||||
ASSERT(pColTriPlanes != NULL);
|
||||
|
||||
if ( Abs(pColTriPlanes[i].normal.z) > 0.1f )
|
||||
CVector normal;
|
||||
pColTriPlanes[i].GetNormal(normal);
|
||||
if ( Abs(normal.z) > 0.1f )
|
||||
{
|
||||
CColTriangle *pColTri = pCol->triangles;
|
||||
ASSERT(pColTri != NULL);
|
||||
|
|
Loading…
Reference in a new issue