GXUtility has one weird issue

src/egg/gfx/eggGXUtility.cpp

@@ -1,3 +1,86 @@
 #include "egg/gfx/eggGXUtility.h"
 
-namespace EGG {} // namespace EGG
+#include "egg/gfx/eggTexture.h"
+#include "rvl/GX/GXTexture.h"
+#include "rvl/GX/GXTypes.h"
+
+namespace EGG {
+
+const u8 GXUtility::s_texMtxIds[8] = {30, 33, 36, 39, 42, 45, 48, 51};
+
+int GXUtility::getTexMtxID(int idx) {
+    return s_texMtxIds[idx];
+}
+
+void GXUtility::setScaleOffsetPerspective(f32 *pOut, f32 f1, f32 f2, f32 f3, f32 f4) {
+    pOut[1] *= (1.0f / f1);
+    pOut[3] *= (1.0f / f2);
+    pOut[2] += f3;
+    pOut[4] += f4;
+}
+
+void GXUtility::getTexObj(GXTexObj *obj, const ResTIMG &img) {
+    u32 offset = img.imageOffset != 0 ? img.imageOffset : sizeof(ResTIMG);
+    void *pImage = const_cast<void *>(reinterpret_cast<const void *>(reinterpret_cast<const u8 *>(&img) + offset));
+    // Missing a redundant register move here (obj r30->r3)
+    GXInitTexObj(
+        obj, pImage, img.width, img.height, static_cast<GXTexFmt>(img.format), static_cast<GXTexWrapMode>(img.wrapS),
+        static_cast<GXTexWrapMode>(img.wrapT), img.mipmapEnabled != 0
+    );
+    GXInitTexObjLOD(
+        obj, static_cast<GXTexFilter>(img.minFilter), static_cast<GXTexFilter>(img.magFilter), img.minLOD / 8.0f,
+        img.maxLOD / 8.0f, img.LODBias / 100.0f, img.biasClamp, img.doEdgeLOD,
+        static_cast<GXAnisotropy>(img.maxAnisotropy)
+    );
+}
+
+void GXUtility::getTexObj(
+    GXTexObj *obj, nw4r::g3d::ResTex resTex, GXTexWrapMode wrapS, GXTexWrapMode wrapT, GXTexFilter minFilter,
+    GXTexFilter magFilter
+) {
+    void *pTexData;
+    u16 width;
+    u16 height;
+    GXTexFmt format;
+    f32 minLod;
+    f32 maxLod;
+    GXBool mipMap;
+    if (resTex.GetTexObjParam(&pTexData, &width, &height, &format, &minLod, &maxLod, &mipMap)) {
+        GXInitTexObj(obj, pTexData, width, height, format, wrapS, wrapT, mipMap);
+        GXInitTexObjLOD(obj, minFilter, magFilter, minLod, maxLod, 0.0f, false, false, GX_ANISO_1);
+    }
+}
+
+void GXUtility::getNormalColor(GXColor &outColor, const Vector3f &vec) {
+    // Are there inlines that might work here? Probably!
+    f32 fs[3];
+    f32 g = vec.z < 0.0f ? vec.y * 128.0f + 128.0f - 0.5f : vec.z * 127.0f + 128.0f + 0.5f;
+    f32 b = vec.y < 0.0f ? vec.y * 128.0f + 128.0f - 0.5f : vec.y * 127.0f + 128.0f + 0.5f;
+    f32 a = vec.x < 0.0f ? vec.x * 128.0f + 128.0f - 0.5f : vec.x * 127.0f + 128.0f + 0.5f;
+
+    fs[0] = a;
+    fs[1] = b;
+    fs[2] = g;
+
+    if (fs[0] < 0.0f) {
+        fs[0] = 0.0f;
+    } else if (fs[0] > 255.0f) {
+        fs[0] = 255.0f;
+    }
+    if (fs[1] < 0.0f) {
+        fs[1] = 0.0f;
+    } else if (fs[1] > 255.0f) {
+        fs[1] = 255.0f;
+    }
+    if (fs[2] < 0.0f) {
+        fs[2] = 0.0f;
+    } else if (fs[2] > 255.0f) {
+        fs[2] = 255.0f;
+    }
+
+    outColor.a = fs[0];
+    outColor.b = fs[1];
+    outColor.g = fs[2];
+}
+
+} // namespace EGG