Prescale Clq matched

TheOnlyZac · Aug 26, 2024 · a29f3e0 · a29f3e0
1 parent 76546e5
commit a29f3e0
Show file tree

Hide file tree

Showing 2 changed files with 8 additions and 2 deletions.
diff --git a/config/symbol_addrs.txt b/config/symbol_addrs.txt
@@ -795,7 +795,7 @@ GRandInRange__Fff = 0x1EAAE0; // type:func
 GRandGaussian = 0x1EAB48; // type:func
 FFloatsNear__Ffff = 0x1EAC68; // type:func
 CSolveQuadratic = 0x1EACA0; // type:func
-PrescaleClq = 0x1EAD30; // type:func
+PrescaleClq__FP3CLQffT0 = 0x1EAD30; // type:func
 CalculateSinCos__FfPfT1 = 0x1EAD88; // type:func
 GTrunc = 0x1EAE78; // type:func
 GTrunc1 = 0x1EAF28; // type:func

diff --git a/src/P2/util.c b/src/P2/util.c
@@ -1,4 +1,5 @@
 #include <util.h>
+#include <vec.h>
 #include <sce/rand.h>
 #include <sce/math.h>
 
@@ -103,7 +104,12 @@ int FFloatsNear(float g1,float g2,float gEpsilon)
 
 INCLUDE_ASM(const s32, "P2/util", CSolveQuadratic);
 
-INCLUDE_ASM(const s32, "P2/util", PrescaleClq);
+void PrescaleClq(CLQ *pclqSrc, float ru, float du, CLQ *pclqDst)
+{
+    pclqDst->w = pclqSrc->w * ru * ru;
+    pclqDst->v = (pclqSrc->w + pclqSrc->w) * ru * du + pclqSrc->v * ru;
+    pclqDst->u = pclqSrc->w * du * du + pclqSrc->v * du + pclqSrc->u;
+}
 
 INCLUDE_ASM(const s32, "P2/util", CalculateSinCos__FfPfT1);