From 763c2a0f92ce505dca8b28062ea85fc20724678b Mon Sep 17 00:00:00 2001
From: LuigiBlood <luigiblood@gmail.com>
Date: Sun, 6 Aug 2023 14:01:49 +0200
Subject: [PATCH] leoC2_4_ecc match

---
 src/libleo/leoc2ecc.c | 177 +++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 176 insertions(+), 1 deletion(-)

diff --git a/src/libleo/leoc2ecc.c b/src/libleo/leoc2ecc.c
index 73b3e6c..6a48705 100644
--- a/src/libleo/leoc2ecc.c
+++ b/src/libleo/leoc2ecc.c
@@ -214,7 +214,182 @@ c2_3_1:
     } while (--byte != 0);
 }
 
-#pragma GLOBAL_ASM("asm/nonmatchings/libleo/leoc2ecc/leoC2_4_ecc.s")
+void leoC2_4_ecc(void) {
+    register u32 s0;
+    register u32 R0;
+    register u32 R1;
+    register u32 R2;
+    register u32 R3;
+    u8* pointer1;
+    u8* pointer2;
+    u8* pointer3;
+    u8* pointer4;
+    u32 aa;
+    u32 bb;
+    u32 dd;
+    u32 ee;
+    u32 gg;
+    u32 hh;
+    u32 pp;
+    u32 qq;
+    u32 ll;
+    u32 ii;
+    u32 jj;
+    u32 kk;
+    u32 byte;
+    u32 s;
+    u32 a;
+    u32 e;
+    u32 g;
+    u32 p;
+    u32 c;
+    u32 f;
+    u32 o;
+    u32 r;
+    u32 t;
+    u32 u;
+    u32 v;
+    u32 b;
+    u32 d;
+    u32 h;
+    u32 q;
+    u8* p_s;
+
+    ii = 0x58 - LEOc2_param.err_pos[0];
+    jj = 0x58 - LEOc2_param.err_pos[1];
+    kk = 0x58 - LEOc2_param.err_pos[2];
+    ll = 0x58 - LEOc2_param.err_pos[3];
+
+    ii = ganlog[ii];
+    jj = ganlog[jj];
+    kk = ganlog[kk];
+    ll = ganlog[ll];
+    s = ganlog[0];
+
+    aa = leoAlpha_div(s, ii);
+    bb = leoAlpha_div(s, jj);
+    ee = leoAlpha_div(s, kk);
+    dd = leoAlpha_div(s, ll);
+
+    a = leoAlpha_mult(bb, ee);
+    e = leoAlpha_mult(ee, dd);
+    g = leoAlpha_mult(dd, bb);
+    p = leoAlpha_mult(dd, aa);
+    c = leoAlpha_mult(aa, ee);
+    f = leoAlpha_mult(aa, bb);
+
+    b = a ^ e ^ g;
+    d = e ^ p ^ c;
+    h = p ^ f ^ g;
+    q = f ^ a ^ c;
+    a = bb ^ ee ^ dd;
+    e = ee ^ dd ^ aa;
+    g = dd ^ aa ^ bb;
+    p = aa ^ bb ^ ee;
+
+    c = leoAlpha_mult(leoAlpha_mult(bb, ee), dd);
+    f = leoAlpha_mult(leoAlpha_mult(ee, dd), aa);
+    o = leoAlpha_mult(leoAlpha_mult(dd, aa), bb);
+    r = leoAlpha_mult(leoAlpha_mult(aa, bb), ee);
+
+    s = leoAlpha_mult(leoAlpha_mult(leoAlpha_div(ii, jj) ^ 1, leoAlpha_div(ii, kk) ^ 1), leoAlpha_div(ii, ll) ^ 1);
+    s = leoAlpha_div(1, s);
+    t = leoAlpha_mult(leoAlpha_mult(leoAlpha_div(jj, ii) ^ 1, leoAlpha_div(jj, kk) ^ 1), leoAlpha_div(jj, ll) ^ 1);
+    t = leoAlpha_div(1, t);
+    u = leoAlpha_mult(leoAlpha_mult(leoAlpha_div(kk, ii) ^ 1, leoAlpha_div(kk, jj) ^ 1), leoAlpha_div(kk, ll) ^ 1);
+    u = leoAlpha_div(1, u);
+    v = leoAlpha_mult(leoAlpha_mult(leoAlpha_div(ll, ii) ^ 1, leoAlpha_div(ll, jj) ^ 1), leoAlpha_div(ll, kk) ^ 1);
+    v = leoAlpha_div(1, v);
+
+    aa = glog[leoAlpha_mult(a, s)];
+    bb = glog[leoAlpha_mult(b, s)];
+    c = leoAlpha_mult(c, s);
+    ee = glog[leoAlpha_mult(e, t)];
+    dd = glog[leoAlpha_mult(d, t)];
+    f = leoAlpha_mult(f, t);
+    gg = glog[leoAlpha_mult(g, u)];
+    hh = glog[leoAlpha_mult(h, u)];
+    o = leoAlpha_mult(o, u);
+    pp = glog[leoAlpha_mult(p, v)];
+    qq = glog[leoAlpha_mult(q, v)];
+    r = leoAlpha_mult(r, v);
+
+    s = glog[s];
+    c = glog[c];
+    t = glog[t];
+    f = glog[f];
+    u = glog[u];
+    o = glog[o];
+    v = glog[v];
+    r = glog[r];
+
+    byte = LEOc2_param.bytes;
+    
+    if (LEOc2_param.err_pos[3] < 0x55) goto c2_4_4;
+    pointer4 = &LEO_TempBuffer[sizeof(LEO_TempBuffer)];
+    if (LEOc2_param.err_pos[2] < 0x55) goto c2_4_3;
+    pointer3 = &LEO_TempBuffer[sizeof(LEO_TempBuffer)];
+    if (LEOc2_param.err_pos[1] < 0x55) goto c2_4_2;
+    pointer2 = &LEO_TempBuffer[sizeof(LEO_TempBuffer)];
+    if (LEOc2_param.err_pos[0] < 0x55) goto c2_4_1;
+    return;
+    
+c2_4_4:
+    pointer4 = &LEOc2_param.pntr[(LEOc2_param.err_pos[3] + 1) * byte];
+c2_4_3:
+    pointer3 = &LEOc2_param.pntr[(LEOc2_param.err_pos[2] + 1) * byte];
+c2_4_2:
+    pointer2 = &LEOc2_param.pntr[(LEOc2_param.err_pos[1] + 1) * byte];
+c2_4_1:
+    pointer1 = &LEOc2_param.pntr[(LEOc2_param.err_pos[0] + 1) * byte];
+    p_s = LEOc2_param.c2buff_e;
+
+    do {
+        p_s -= 4;
+        s0 = p_s[0];
+        if (!s0) {
+            R0 = R1 = R2 = R3 = 0;
+        } else {
+            s0 = glog[s0];
+            R0 = ganlog[s0 + s];
+            R1 = ganlog[s0 + t];
+            R2 = ganlog[s0 + u];
+            R3 = ganlog[s0 + v];
+        }
+        s0 = p_s[1];
+        if (s0) {
+            s0 = glog[s0];
+            R0 ^= (!a) ? 0 : ganlog[s0 + aa];
+            R1 ^= (!e) ? 0 : ganlog[s0 + ee];
+            R2 ^= (!g) ? 0 : ganlog[s0 + gg];
+            R3 ^= (!p) ? 0 : ganlog[s0 + pp];
+        }
+        s0 = p_s[2];
+        if (s0) {
+            s0 = glog[s0];
+            R0 ^= (!b) ? 0 : ganlog[s0 + bb];
+            R1 ^= (!d) ? 0 : ganlog[s0 + dd];
+            R2 ^= (!h) ? 0 : ganlog[s0 + hh];
+            R3 ^= (!q) ? 0 : ganlog[s0 + qq];
+        }
+        s0 = p_s[3];
+        if (s0) {
+            s0 = glog[s0];
+            R0 ^= ganlog[s0 + c];
+            R1 ^= ganlog[s0 + f];
+            R2 ^= ganlog[s0 + o];
+            R3 ^= ganlog[s0 + r];
+        }
+        pointer1--;
+        pointer2--;
+        pointer3--;
+        pointer4--;
+        if (R0) *pointer1 ^= R0;
+        if (R1) *pointer2 ^= R1;
+        if (R2) *pointer3 ^= R2;
+        if (R3) *pointer4 ^= R3;
+    } while (--byte != 0);
+}
 
 s32 leoAlpha_mult(s32 i, s32 k) {
     if ((i == 0) || (k == 0)) {