leoC2_single_ecc match

pret · Aug 4, 2023 · 97f31ca · 97f31ca
1 parent f269d58
commit 97f31ca
Showing 1 changed file with 15 additions and 1 deletion.
diff --git a/src/libleo/leoc2ecc.c b/src/libleo/leoc2ecc.c
@@ -36,7 +36,21 @@ s32 leoC2_Correction(void) {
 #pragma GLOBAL_ASM("asm/nonmatchings/libleo/leoc2ecc/leoC2_Correction.s")
 #endif
 
-#pragma GLOBAL_ASM("asm/nonmatchings/libleo/leoc2ecc/leoC2_single_ecc.s")
+void leoC2_single_ecc(void) {
+    u8* pointer;
+    u32 byte;
+    u8* p_s;
+
+    if (LEOc2_param.err_pos[0] < 0x55) {
+        byte = LEOc2_param.bytes;
+        pointer = &LEOc2_param.pntr[(LEOc2_param.err_pos[0] + 1) * byte];
+        p_s = LEOc2_param.c2buff_e;
+
+        do {
+            *(--pointer) ^= *(p_s -= 4);
+        } while(--byte != 0);
+    }
+}
 
 #pragma GLOBAL_ASM("asm/nonmatchings/libleo/leoc2ecc/leoC2_double_ecc.s")