1 files changed, 66 insertions, 0 deletions
diff --git a/arm9/lib/src/GX_g2.c b/arm9/lib/src/GX_g2.c
new file mode 100644
index 00000000..66273541
--- /dev/null
+++ b/arm9/lib/src/GX_g2.c
@@ -0,0 +1,66 @@
+#include "global.h"
+#include "main.h"
+#include "GX.h"
+
+ARM_FUNC void G2x_SetBGyAffine_(u32 *ptr, struct Mtx22 *mtx, fx32 a, fx32 b, fx32 c, fx32 d){
+    fx32 temp0, temp1, temp2, temp3;
+    ptr[0] = ((u16)(fx16)(mtx->_[0] >> 4) | (u16)(fx16)(mtx->_[1] >> 4)<< 0x10);
+    ptr[1] = ((u16)(fx16)(mtx->_[2] >> 4) | (u16)(fx16)(mtx->_[3] >> 4)<< 0x10);
+    temp0 = c - a;
+    temp1 = d - b;
+    temp2 = mtx->_[0] * temp0 + mtx->_[1] * temp1 + (a << 0xC);
+    temp3 = mtx->_[2] * temp0 + mtx->_[3] * temp1 + (b << 0xC);
+    ptr[2] = temp2 >> 4;
+    ptr[3] = temp3 >> 4;
+}
+
+ARM_FUNC void G2x_SetBlendAlpha_(u32 *ptr, fx32 a, fx32 b, fx32 c, fx32 d){
+    *ptr = ((a | 0x40) | (b << 0x8)) | ((c | (d << 0x8)) << 0x10);
+}
+
+ARM_FUNC void G2x_SetBlendBrightness_(u16 *ptr, fx32 a, fx32 brightness){
+    if (brightness < 0)
+    {
+        ptr[0] = a | 0xC0;
+        ptr[2] = -brightness;
+    }
+    else
+    {
+        ptr[0] = a | 0x80;
+        ptr[2] = brightness;
+    }
+}
+
+ARM_FUNC void G2x_SetBlendBrightnessExt_(u16 *ptr, fx32 a, fx32 b, fx32 c, fx32 d, fx32 brightness){
+    ptr[1] = c | (d << 0x8);
+    if (brightness < 0)
+    {
+        ptr[0] = 0xC0 | a | (b << 0x8);
+        ptr[2] = -brightness;
+    }
+    else
+    {
+        ptr[0] = 0x80 | a | (b << 0x8);
+        ptr[2] = brightness;
+    }
+}
+
+ARM_FUNC void *G2x_ChangeBlendBrightness_(u16 *ptr, fx32 brightness){
+    u32 temp = *ptr;
+    if (brightness < 0)
+    {
+        if ((temp & 0xC0) == 0x80)
+        {
+            ptr[0] = temp & ~0xC0 | 0xC0;
+        }
+        ptr[2] = -brightness;
+    }
+    else
+    {
+        if ((temp & 0xC0) == 0xC0)
+        {
+            ptr[0] = temp & ~0xC0 | 0x80;
+        }
+        ptr[2] = brightness;
+    }
+}