#include <ultra64.h>
#include <macros.h>
#include <math_util.h>
#include <variables.h>
#include <main.h>
#include "framebuffers.h"
// Location based from sm64.
// This may need to be moved before framebuffers.c
// If math_util has data that does not line-up with trig_tables.
#include "trig_tables.inc.c"
#pragma intrinsic (sqrtf)

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
s32 func_802B4F60(s32 arg0, f32 *arg2, f32 arg3, f32 arg4) {
    f32 sp2C;
    f32 sp1C;
    s32 var_v0;

    vec3f_copy(&sp1C, arg2);
    sp2C = sp6C + ((sp30[3] * sp1C) + (sp4C * sp20) + (sp5C * sp24));
    func_802B6434(&sp1C, (f32 (*)[4]) &sp30[0]);
    var_v0 = 1;
    if (sp2C <= 0.0f) {
        var_v0 = 0;
    }
    return var_v0;
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B4F60.s")
#endif

UNUSED void func_802B4FF0() {

}

s32 func_802B4FF8(Mat4 arg0, s32 arg1) {
    if (D_80150112 >= 0x80) {
        return 0;
    }
    func_802B75F8(&gGfxPool->mtxPool[D_80150112 + 0x32B], arg0);
    switch (arg1) {                                 /* irregular */
        case 0:
            gSPMatrix(gDisplayListHead++, VIRTUAL_TO_PHYSICAL(&gGfxPool->mtxPool[D_80150112 + 0x32B]), G_MTX_NOPUSH | G_MTX_LOAD | G_MTX_MODELVIEW);
            D_80150112 += 1;
            break;
        case 1:
            gSPMatrix(gDisplayListHead++, VIRTUAL_TO_PHYSICAL(&gGfxPool->mtxPool[D_80150112 + 0x32B]), G_MTX_PUSH | G_MTX_LOAD | G_MTX_MODELVIEW);
            D_80150112 += 1;
            break;
        case 3:
            gSPMatrix(gDisplayListHead++, VIRTUAL_TO_PHYSICAL(&gGfxPool->mtxPool[D_80150112 + 0x32B]), G_MTX_PUSH | G_MTX_MUL | G_MTX_MODELVIEW);
            D_80150112 += 1;
            break;
        case 2:
            gSPMatrix(gDisplayListHead++, VIRTUAL_TO_PHYSICAL(&gGfxPool->mtxPool[D_80150112 + 0x32B]), G_MTX_NOPUSH | G_MTX_MUL | G_MTX_MODELVIEW);
            D_80150112 += 1;
            break;
    }
    return 1;
}

f32 func_802B51E8(Vec3f arg0, Vec3f arg1) {
    f32 temp_f12;
    f32 temp_f14;
    f32 temp_f2;

    temp_f2 = arg1[0] - arg0[0];
    temp_f12 = arg1[1] - arg0[1];
    temp_f14 = arg1[2] - arg0[2];
    return (temp_f2 * temp_f2) + (temp_f12 * temp_f12) + temp_f14 + temp_f14;
}
//u32 atan2s(f32, f32);  // might be s32
u32 func_802B5224(Vec3f arg0, Vec3f arg1) {
    f32 temp_v1;
    f32 temp_v2;
    temp_v1 = arg1[0] - arg0[0];
    temp_v2 = arg1[2] - arg0[2];

    return atan2s(temp_v1, temp_v2);
}

u32 func_802B5258(Vec3f arg0, Vec3s arg1) {
    f32 temp_v1;
    f32 temp_v2;
    temp_v1 = arg1[0] - arg0[0];
    temp_v2 = arg1[2] - arg0[2];
    
    return atan2s(temp_v1, temp_v2);
}

void vec3f_set(Vec3f arg0, f32 arg1, f32 arg2, f32 arg3) {
    arg0[0] = arg1;
    arg0[1] = arg2;
    arg0[2] = arg3;
}

void vec3s_set(Vec3s arg0, s16 arg1, s16 arg2, s16 arg3) {
    arg0[0] = arg1;
    arg0[1] = arg2;
    arg0[2] = arg3;
}

// These functions have bogus return values.
// Disable the compiler warning.
#pragma GCC diagnostic push

#ifdef __GNUC__
#if defined(__clang__)
  #pragma GCC diagnostic ignored "-Wreturn-stack-address"
#else
  #pragma GCC diagnostic ignored "-Wreturn-local-addr"
#endif
#endif

void *vec3f_copy(Vec3f dest, Vec3f src) {
    dest[0] = src[0];
    dest[1] = src[1];
    dest[2] = src[2];
    return &dest; //! warning: function returns address of local variable
}

void vec3s_copy(Vec3s dest, Vec3s src) {
    dest[0] = src[0];
    dest[1] = src[1];
    dest[2] = src[2];
}

UNUSED void *sm64_vec3f_set(Vec3f dest, f32 x, f32 y, f32 z) {
    dest[0] = x;
    dest[1] = y;
    dest[2] = z;
    return &dest;
}

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
void func_802B5350(f32 (*arg0)[4], f32 (*arg1)[4]) {
    f32 (*var_a2)[4];
    f32 (*var_v1)[4];
    f32 temp_f6;
    s32 var_v0;

    var_a2 = arg0;
    var_v0 = 0;
    var_v1 = arg1;
    do {
        var_v0 += 1;
        var_v1 += 0x10;
        var_v1->unk-10 = (f32) var_a2[0][0];
        temp_f6 = var_a2[0][1];
        var_a2 += 0x10;
        var_v1->unk-C = temp_f6;
        var_v1->unk-8 = (f32) var_a2->unk-8;
        var_v1->unk-4 = (f32) var_a2->unk-4;
    } while (var_v0 != 4);
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B5350.s")
#endif

// mtxf_copy
void func_802B5398(s32 *dest, s32 *src, s32 arg2) {
   while (arg2-- > 0) {
        *dest++ = *src++;
   }
}

void mtxf_identity(Mat4 mtx) {
    register s32 i;
    register s32 k;

    for (i = 0; i < 4; i++) {
        for (k = 0; k < 4; k++) {
            mtx[i][k] = (i == k) ? 1.0f : 0.0f;
        }
    } 
}

void func_802B5450(Mat4 arg0, Mat4 arg1, Vec3f arg2) {
    arg1[3][0] = arg0[3][0] + arg2[0];
    arg1[3][1] = arg0[3][1] + arg2[1];
    arg1[3][2] = arg0[3][2] + arg2[2];
    arg1[3][3] = arg0[3][3];
    arg1[0][0] = arg0[0][0];
    arg1[0][1] = arg0[0][1];
    arg1[0][2] = arg0[0][2];
    arg1[0][3] = arg0[0][3];
    arg1[1][0] = arg0[1][0];
    arg1[1][1] = arg0[1][1];
    arg1[1][2] = arg0[1][2];
    arg1[1][3] = arg0[1][3];
    arg1[2][0] = arg0[2][0];
    arg1[2][1] = arg0[2][1];
    arg1[2][2] = arg0[2][2];
    arg1[2][3] = arg0[2][3];
}

UNUSED void func_802B54EC(Mat4 arg0, Mat4 arg1, Vec3f arg2) {
    arg1[3][0] = arg0[3][0] + arg2[0];
    arg1[3][1] = arg0[3][1] + arg2[1];
    arg1[3][2] = arg0[3][2] + arg2[2];
}

void mtxf_translate(Mat4 dest, Vec3f b) {
    mtxf_identity(dest);
    dest[3][0] = b[0];
    dest[3][1] = b[1];
    dest[3][2] = b[2];
}
extern f64 D_802B9FB0; // = 0.017453292222222222;
// Note the use of `2` which generates diff asm than just using floats (2.0f).
void func_802B5564(Mat4 arg0, u16 *arg1, f32 arg2, f32 arg3, f32 arg4, f32 arg5, f32 arg6) {
    f32 temp;
    s32 i, j;
    mtxf_identity(arg0);
    arg2 *= D_802B9FB0;
    temp = cosf(arg2 / 2) / sinf(arg2 / 2);
    arg0[0][0] = temp / arg3;
    arg0[1][1] = temp;
    arg0[2][2] = (arg4 + arg5) / (arg4 - arg5);
    arg0[2][3] = -1.0f;
    arg0[3][2] = (2 * arg4 * arg5) / (arg4 - arg5);
    arg0[3][3] = 0.0f;

    for (i = 0; i < 4; i++) {
        for (j = 0; j < 4; j++) {
            arg0[i][j] *= arg6;
        }
    }

    if (arg1 != 0) {
        if ((arg4 + arg5) <= 2.0) {
            *arg1 = 0xFFFF;
        }
        else {
            *arg1 = 131072.0 / (arg4 + arg5);
            if (*arg1 <= 0) {
                *arg1 = 1;
            }
        }
    }
}

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
void func_802B5794(f32 (*arg0)[4], f32 *arg1, f32 *arg2) {
    f32 sp4C;
    f32 sp48;
    f32 sp30;
    f32 temp_f10;
    f32 temp_f12;
    f32 temp_f12_2;
    f32 temp_f14;
    f32 temp_f14_2;
    f32 temp_f16;
    f32 temp_f16_2;
    f32 temp_f16_3;
    f32 temp_f18;
    f32 temp_f18_2;
    f32 temp_f20;
    f32 temp_f20_2;
    f32 temp_f22;
    f32 temp_f22_2;
    f32 temp_f28;
    f32 temp_f2;
    f32 temp_f2_2;
    f32 temp_f6;

    temp_f12 = arg2->unk0 - arg1->unk0;
    temp_f14 = arg2->unk4 - arg1->unk4;
    temp_f2 = arg2->unk8 - arg1->unk8;
    temp_f16 = (f32) (-1.0 / (f64) sqrtf((temp_f12 * temp_f12) + (temp_f14 * temp_f14) + (temp_f2 * temp_f2)));
    temp_f12_2 = temp_f12 * temp_f16;
    temp_f14_2 = temp_f14 * temp_f16;
    temp_f2_2 = temp_f2 * temp_f16;
    temp_f16_2 = 0.0f - (1.0f * temp_f12_2);
    temp_f22 = (f32) (1.0 / (f64) sqrtf((temp_f2_2 * temp_f2_2) + 0.0f + (temp_f16_2 * temp_f16_2)));
    temp_f28 = temp_f2_2 * temp_f22;
    temp_f18 = temp_f16_2 * temp_f22;
    temp_f6 = temp_f14_2 * temp_f18;
    sp30 = temp_f18;
    temp_f20 = temp_f6 - (temp_f2_2 * 0.0f);
    temp_f16_3 = (temp_f2_2 * temp_f28) - (temp_f12_2 * sp30);
    temp_f18_2 = (temp_f12_2 * 0.0f) - (temp_f14_2 * temp_f28);
    temp_f22_2 = (f32) (1.0 / (f64) sqrtf((temp_f20 * temp_f20) + (temp_f16_3 * temp_f16_3) + (temp_f18_2 * temp_f18_2)));
    temp_f20_2 = temp_f20 * temp_f22_2;
    temp_f10 = temp_f18_2 * temp_f22_2;
    sp4C = temp_f16_3 * temp_f22_2;
    sp48 = temp_f10;
    arg0[0][0] = temp_f28;
    arg0->unk10 = 0.0f;
    arg0->unk20 = sp30;
    arg0->unk30 = (f32) -((arg1->unk8 * sp30) + ((arg1->unk0 * temp_f28) + (arg1->unk4 * 0.0f)));
    arg0[0][1] = temp_f20_2;
    arg0->unk24 = sp48;
    arg0->unk14 = sp4C;
    arg0[0][2] = temp_f12_2;
    arg0->unk18 = temp_f14_2;
    arg0->unk28 = temp_f2_2;
    arg0->unk34 = (f32) -((arg1->unk8 * sp48) + ((arg1->unk0 * temp_f20_2) + (arg1->unk4 * sp4C)));
    arg0[0][3] = 0.0f;
    arg0->unk1C = 0.0f;
    arg0->unk2C = 0.0f;
    arg0->unk3C = 1.0f;
    arg0->unk38 = (f32) -((arg1->unk8 * temp_f2_2) + ((arg1->unk0 * temp_f12_2) + (arg1->unk4 * temp_f14_2)));
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B5794.s")
#endif

void func_802B59DC(Mat4 arg0, s16 arg1) {
    f32 sp28 = sins(arg1);
    f32 temp_f0 = coss(arg1);

    mtxf_identity(arg0);
    arg0[1][1] = temp_f0;
    arg0[1][2] = sp28;
    arg0[2][1] = -sp28;
    arg0[2][2] = temp_f0;
}

void func_802B5A44(Mat4 arg0, s16 arg1) {
    f32 temp_f0 = sins(arg1);
    f32 sp28 = coss(arg1);

    mtxf_identity(arg0);
    arg0[0][0] = sp28;
    arg0[0][2] = -temp_f0;
    arg0[2][0] = temp_f0;
    arg0[2][2] = sp28;
}

void func_802B5AAC(Mat4 arg0, s16 arg1) {
    f32 temp_f0 = sins(arg1);
    f32 sp28 = coss(arg1);

    mtxf_identity(arg0);
    arg0[0][0] = sp28;
    arg0[0][1] = temp_f0;
    arg0[1][0] = -temp_f0;
    arg0[1][1] = sp28;
}

#ifdef MIPS_TO_C
//generated by m2c commit 8267401fa4ef7a38942dcca43353cc1bcc6efabc
void func_802B5B14(Vec3f arg0, Vec3s arg1) {
    f32 sp70;
    f32 sp6C;
    f32 sp68;
    f32 sp60;
    f32 sp5C;
    f32 sp58;
    f32 sp50;
    f32 sp4C;
    f32 sp48;
    f32 sp40;
    f32 sp3C;
    f32 sp38;
    f32 sp30;
    f32 sp2C;
    f32 sp28;
    f32 temp_f0;
    f32 temp_f10;
    f32 temp_f12;
    f32 temp_f18;
    f32 temp_f20;
    f32 temp_f4;
    f32 temp_f6;

    sp38 = sins((u16) arg1->unk0);
    temp_f20 = coss((u16) arg1->unk0);
    sp30 = sins(arg1->unk2);
    sp2C = coss(arg1->unk2);
    sp28 = sins(arg1->unk4);
    temp_f0 = coss(arg1->unk4);
    temp_f4 = arg0->unk0;
    temp_f12 = sp38 * sp30;
    sp3C = temp_f4;
    sp40 = arg0->unk4;
    temp_f6 = (sp2C * temp_f0) + (temp_f12 * sp28);
    sp48 = temp_f6;
    sp58 = (-sp2C * sp28) + (temp_f12 * temp_f0);
    sp68 = temp_f20 * sp30;
    sp4C = temp_f20 * sp28;
    temp_f18 = sp38 * sp2C;
    sp5C = temp_f20 * temp_f0;
    sp6C = -sp38;
    temp_f10 = (-sp30 * temp_f0) + (temp_f18 * sp28);
    sp50 = temp_f10;
    sp60 = (sp30 * sp28) + (temp_f18 * temp_f0);
    sp70 = temp_f20 * sp2C;
    arg0->unk0 = (temp_f10 * sp40) + ((temp_f4 * temp_f6) + (sp40 * sp4C));
    arg0->unk4 = (f32) ((sp60 * sp40) + ((temp_f4 * sp58) + (sp40 * sp5C)));
    arg0->unk8 = (f32) ((sp70 * sp40) + ((sp3C * sp68) + (sp40 * sp6C)));
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B5B14.s")
#endif

void func_802B5CAC(s16 arg0, s16 arg1, Vec3f arg2) {
    f32 sp2C = sins(arg1);
    f32 sp28 = coss(arg1);
    f32 sp24 = sins(arg0);
    f32 temp_f10 = coss(arg0);

    arg2[0] = sp28 * sp24;
    arg2[1] = sp2C;
    arg2[2] = -(sp28 * temp_f10);
}

void func_802B5D30(s16 arg0, s16 arg1, s32 arg2) {
    func_802B5D64(0x9000000, arg0, arg1, arg2);
}

#ifdef MIPS_TO_C
//generated by mips_to_c commit bd0364fa19633bd6201f8007e2d0a7ed87825909
f32 sins(s32);                             /* extern */
f32 coss(s32);                             /* extern */
extern uintptr_t gSegmentTable;

void func_802B5D64(u32 arg0, u16 arg1, s32 arg2, s32 arg3) {
    f32 sp48;
    f32 sp44;
    f32 sp40;
    s8 sp2E;
    s8 sp2D;
    s8 sp2C;
    s32 sp20;
    f32 temp_f10;
    s32 temp_a0;
    s32 temp_a0_2;
    s32 temp_v0;
    s32 temp_v0_2;
    void *temp_s0;
    void *temp_s0_2;
    void *temp_s0_3;
    void *phi_s0;
    s32 phi_v0;
    void *phi_s0_2;
    s32 phi_v0_2;

    temp_a0 = arg2 & 0xFFFF;
    temp_s0 = *(&gSegmentTable + ((arg0 >> 0x18) * 4)) + (arg0 & 0xFFFFFF) + 0x80000000;
    sp20 = temp_a0;
    sp48 = sins(temp_a0);
    sp44 = coss(temp_a0);
    sp20 = arg1;
    sp40 = sins(arg1);
    temp_a0_2 = arg3 & 3;
    temp_f10 = sp44 * coss(arg1) * -120.0f;
    sp2C = sp44 * sp40 * 120.0f;
    sp2D = 120.0f * sp48;
    sp2E = temp_f10;
    phi_v0 = 0;
    phi_v0_2 = 0;
    if (arg3 > 0) {
        phi_s0 = temp_s0;
        phi_s0_2 = temp_s0;
        if (temp_a0_2 != 0) {
            do {
                temp_v0 = phi_v0 + 1;
                temp_s0_2 = phi_s0 + 0x18;
                temp_s0_2->unk-8 = sp2C;
                temp_s0_2->unk-7 = sp2D;
                temp_s0_2->unk-6 = sp2E;
                phi_s0 = temp_s0_2;
                phi_v0 = temp_v0;
                phi_s0_2 = temp_s0_2;
                phi_v0_2 = temp_v0;
            } while (temp_a0_2 != temp_v0);
            if (temp_v0 != arg3) {
                goto loop_4;
            }
        } else {
            do {
loop_4:
                temp_v0_2 = phi_v0_2 + 4;
                temp_s0_3 = phi_s0_2 + 0x60;
                temp_s0_3->unk-50 = sp2C;
                temp_s0_3->unk-4F = sp2D;
                temp_s0_3->unk-4E = sp2E;
                temp_s0_3->unk-38 = sp2C;
                temp_s0_3->unk-37 = sp2D;
                temp_s0_3->unk-36 = sp2E;
                temp_s0_3->unk-20 = sp2C;
                temp_s0_3->unk-1F = sp2D;
                temp_s0_3->unk-1E = sp2E;
                temp_s0_3->unk-8 = sp2C;
                temp_s0_3->unk-7 = sp2D;
                temp_s0_3->unk-6 = sp2E;
                phi_s0_2 = temp_s0_3;
                phi_v0_2 = temp_v0_2;
            } while (temp_v0_2 != arg3);
        }
    }
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B5D64.s")
#endif

void func_802B5F00(Mat4 arg0, f32 arg1) {
    arg0[0][0] *= arg1;
    arg0[1][0] *= arg1;
    arg0[2][0] *= arg1;
    arg0[0][1] *= arg1;
    arg0[1][1] *= arg1;
    arg0[2][1] *= arg1;
    arg0[0][2] *= arg1;
    arg0[1][2] *= arg1;
    arg0[2][2] *= arg1;
}

void func_802B5F74(Mat4 arg0, Vec3f arg1, Vec3s arg2) {
    f32 sine1;
    f32 cosine1;
    f32 sine2;
    f32 cosine2;
    f32 sine3;
    f32 cosine3;

    sine1   = sins(arg2[0]);
    cosine1 = coss(arg2[0]);
    sine2   = sins(arg2[1]);
    cosine2 = coss(arg2[1]);
    sine3   = sins(arg2[2]);
    cosine3 = coss(arg2[2]);
    arg0[0][0] = (cosine2 * cosine3) + ((sine1 * sine2) * sine3);
    arg0[1][0] = (-cosine2 * sine3) + ((sine1 * sine2) * cosine3);
    arg0[2][0] = cosine1 * sine2;
    arg0[3][0] = arg1[0];
    arg0[0][1] = cosine1 * sine3;
    arg0[1][1] = cosine1 * cosine3;
    arg0[2][1] = -sine1;
    arg0[3][1] = arg1[1];
    arg0[0][2] = (-sine2 * cosine3) + ((sine1 * cosine2) * sine3);
    arg0[1][2] = (sine2 * sine3) + ((sine1 * cosine2) * cosine3);
    arg0[2][2] = cosine1 * cosine2;
    arg0[3][2] = arg1[2];
    arg0[0][3] = 0.0f;
    arg0[1][3] = 0.0f;
    arg0[2][3] = 0.0f;
    arg0[3][3] = 1.0f;
}

UNUSED void func_802B60B4(Mat4 arg0, Vec3s arg1, Vec3s arg2) {
    f32 sine1;
    f32 cosine1;
    f32 sine2;
    f32 cosine2;
    f32 sine3;
    f32 cosine3;

    sine1   = sins(arg2[0]);
    cosine1 = coss(arg2[0]);
    sine2   = sins(arg2[1]);
    cosine2 = coss(arg2[1]);
    sine3   = sins(arg2[2]);
    cosine3 = coss(arg2[2]);
    arg0[0][0] = (cosine2 * cosine3) + ((sine1 * sine2) * sine3);
    arg0[0][1] = (-cosine2 * sine3) + ((sine1 * sine2) * cosine3);
    arg0[0][2] = cosine1 * sine2;
    arg0[0][3] = (f32) arg1[0];
    arg0[1][0] = (f32) (cosine1 * sine3);
    arg0[1][1] = (f32) (cosine1 * cosine3);
    arg0[1][2] = (f32) -sine1;
    arg0[1][3] = (f32) arg1[1];
    arg0[2][0] = (f32) ((-sine2 * cosine3) + ((sine1 * cosine2) * sine3));
    arg0[2][1] = (f32) ((sine2 * sine3) + ((sine1 * cosine2) * cosine3));
    arg0[2][2] = (f32) (cosine1 * cosine2);
    arg0[2][3] = (f32) arg1[2];
    arg0[3][0] = 0.0f;
    arg0[3][1] = 0.0f;
    arg0[3][2] = 0.0f;
    arg0[3][3] = 1.0f;
}

UNUSED void func_802B6214(Mat4 arg0, Vec3s arg1, Vec3s arg2) {
    f32 sine1;
    f32 cosine1;
    f32 sine2;
    f32 cosine2;
    f32 sine3;
    f32 cosine3;

    sine1   = sins(arg2[0]);
    cosine1 = coss(arg2[0]);
    sine2   = sins(arg2[1]);
    cosine2 = coss(arg2[1]);
    sine3   = sins(arg2[2]);
    cosine3 = coss(arg2[2]);
    arg0[0][0] = (cosine2 * cosine3) + ((sine1 * sine2) * sine3);
    arg0[1][0] = (-cosine2 * sine3) + ((sine1 * sine2) * cosine3);
    arg0[2][0] = cosine1 * sine2;
    arg0[3][0] = arg1[0];
    arg0[0][1] = cosine1 * sine3;
    arg0[1][1] = cosine1 * cosine3;
    arg0[2][1] = -sine1;
    arg0[3][1] = arg1[1];
    arg0[0][2] = (-sine2 * cosine3) + ((sine1 * cosine2) * sine3);
    arg0[1][2] = (sine2 * sine3) + ((sine1 * cosine2) * cosine3);
    arg0[2][2] = cosine1 * cosine2;
    arg0[3][2] = arg1[2];
    arg0[0][3] = 0.0f;
    arg0[1][3] = 0.0f;
    arg0[2][3] = 0.0f;
    arg0[3][3] = 1.0f;
}

UNUSED void func_802B6374(Vec3f arg0) {
    f32 temp_f0;
    temp_f0 = sqrtf((arg0[0] * arg0[0]) + (arg0[1] * arg0[1]) + (arg0[2] * arg0[2]));
    arg0[0] /= temp_f0;
    arg0[1] /= temp_f0;
    arg0[2] /= temp_f0;
}

void func_802B63B8(Vec3f arg0, Mat3 arg1) {
    f32 temp_f12;
    f32 temp_f16;
    f32 temp_f14;

    temp_f12 = (arg1[0][0] * arg0[0]) + (arg1[0][1] * arg0[1]) + (arg1[0][2] * arg0[2]);
    temp_f16 = (arg1[1][0] * arg0[0]) + (arg1[1][1] * arg0[1]) + (arg1[1][2] * arg0[2]);
    temp_f14 = (arg1[2][0] * arg0[0]) + (arg1[2][1] * arg0[1]) + (arg1[2][2] * arg0[2]);

    arg0[0] = temp_f12;
    arg0[1] = temp_f16;
    arg0[2] = temp_f14;
}

void func_802B6434(Vec3f arg0, Mat4 arg1) {

    f32 temp_f2;
    f32 temp_f16;
    f32 temp_f6;

    temp_f2 = ((arg1[0][0] * arg0[0]) + (arg1[0][1] * arg0[1]) + (arg1[0][2] * arg0[2]));
    temp_f16 = ((arg1[1][0] * arg0[0]) + (arg1[1][1] * arg0[1]) + (arg1[1][2] * arg0[2]));
    temp_f6 = (arg1[2][0] * arg0[0]) + (arg1[2][1] * arg0[1]) + (arg1[2][2] * arg0[2]);


    arg0[0] = temp_f2;
    arg0[1] = temp_f16;
    arg0[2] = temp_f6;
}

UNUSED void func_802B64B0(s32 arg0, s32 arg1, s32 arg2, s32 arg3) {

}

void func_802B64C4(Vec3f arg0, s16 arg1) {
    f32 sp2C = sins(arg1);
    f32 temp_f0 = coss(arg1);

    f32 temp1 = arg0[0];
    f32 temp2 = arg0[1];
    f32 temp3 = arg0[2];

    arg0[0] = temp_f0 * temp1 - (sp2C * temp3);
    arg0[1] = temp2;
    arg0[2] = sp2C * temp1 + (temp_f0 * temp3);
}

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
void func_802B6A84(f32, ?, f32 *, s16, f32, ?, f32);   /* extern */
static f64 D_802B9FB8 = 3.141592653589793;
static f64 D_802B9FC0 = 360.0;

void func_802B6540(f32 (*arg0)[4], f32 arg1, f32 arg2, f32 arg3, u16 arg4) {
    f32 spAC;
    f32 spA8;
    f32 spA4;
    f32 spA0;
    f32 sp9C;
    f32 sp98;
    f32 sp94;
    f32 sp90;
    f32 sp8C;
    f32 sp78;
    f32 sp68;
    f32 sp40;
    s32 sp38;
    f32 *var_a3;
    f32 *var_a3_2;
    f32 *var_v1;
    f32 *var_v1_2;
    f32 temp_f0;
    f32 temp_f0_2;
    s32 var_a0;
    s32 var_a0_2;
    s32 var_v0;
    s32 var_v0_2;

    sp38 = (s32) arg4;
    sp40 = sins(arg4);
    temp_f0 = coss(arg4);
    sp8C = temp_f0;
    spAC = temp_f0;
    sp94 = -sp40;
    sp9C = 1.0f;
    spA8 = 0.0f;
    spA0 = 0.0f;
    spA4 = sp40;
    sp98 = 0.0f;
    sp90 = 0.0f;
    if (arg2 == 1.0f) {
        var_a0 = 0;
        var_a3 = &sp68;
        do {
            var_v0 = 0;
            var_v1 = var_a3;
loop_3:
            if ((var_a0 * 4) == var_v0) {
                *var_v1 = 1.0f;
            } else {
                *var_v1 = 0.0f;
            }
            var_v0 += 4;
            var_v1 += 4;
            if (var_v0 != 0xC) {
                goto loop_3;
            }
            var_a0 += 1;
            var_a3 += 0xC;
        } while (var_a0 != 3);
    } else {
        var_a0_2 = 0;
        var_a3_2 = &sp68;
        if (arg2 == -1.0f) {
            do {
                var_v0_2 = 0;
                var_v1_2 = var_a3_2;
loop_12:
                if ((var_a0_2 * 4) == var_v0_2) {
                    *var_v1_2 = 1.0f;
                } else {
                    *var_v1_2 = 0.0f;
                }
                var_v0_2 += 4;
                var_v1_2 += 4;
                if (var_v0_2 != 0xC) {
                    goto loop_12;
                }
                var_a0_2 += 1;
                var_a3_2 += 0xC;
            } while (var_a0_2 != 3);
            sp78 = -1.0f;
        } else {
            temp_f0_2 = sqrtf((arg1 * arg1) + (arg3 * arg3));
            func_802B6A84(arg1, 0, &sp68, (s16) (s32) (f32) -(D_802B9FC0 - ((f64) (func_802B7CE8(arg2) * 180.0f) / D_802B9FB8)), -arg3 / temp_f0_2, 0, arg1 / temp_f0_2);
        }
    }
    arg0[0][0] = (sp80 * sp94) + ((sp8C * sp68) + (sp90 * sp74));
    arg0[0][3] = (sp80 * spA0) + ((sp98 * sp68) + (sp9C * sp74));
    arg0->unk18 = (f32) ((sp80 * spAC) + ((spA4 * sp68) + (spA8 * sp74)));
    arg0[0][1] = (sp84 * sp94) + ((sp8C * sp6C) + (sp90 * sp78));
    arg0->unk10 = (f32) ((sp84 * spA0) + ((sp98 * sp6C) + (sp9C * sp78)));
    arg0->unk1C = (f32) ((sp84 * spAC) + ((spA4 * sp6C) + (spA8 * sp78)));
    arg0[0][2] = (sp88 * sp94) + ((sp8C * sp70) + (sp90 * sp7C));
    arg0->unk14 = (f32) ((sp88 * spA0) + ((sp98 * sp70) + (sp9C * sp7C)));
    arg0->unk20 = (f32) ((sp88 * spAC) + ((spA4 * sp70) + (spA8 * sp7C)));
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B6540.s")
#endif

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
void func_802B6A84(f32, f32, f32 (*)[4], s16, f32, ?, f32); /* extern */
static f64 D_802B9FC8 = 3.141592653589793;
static f64 D_802B9FD0 = 360.0;

void func_802B68F8(f32 (*arg0)[4], f32 arg1, f32 arg2, f32 arg3) {
    f32 (*var_a3)[4];
    f32 (*var_a3_2)[4];
    f32 (*var_v1)[4];
    f32 (*var_v1_2)[4];
    f32 temp_f0;
    s32 var_a0;
    s32 var_a0_2;
    s32 var_v0;
    s32 var_v0_2;

    if (arg2 == 1.0f) {
        var_a0 = 0;
        var_a3 = arg0;
        do {
            var_v0 = 0;
            var_v1 = var_a3;
loop_3:
            if ((var_a0 * 4) == var_v0) {
                var_v1[0][0] = 1.0f;
            } else {
                var_v1[0][0] = 0.0f;
            }
            var_v0 += 4;
            var_v1 += 4;
            if (var_v0 != 0xC) {
                goto loop_3;
            }
            var_a0 += 1;
            var_a3 += 0xC;
        } while (var_a0 != 3);
        return;
    }
    var_a0_2 = 0;
    var_a3_2 = arg0;
    if (arg2 == -1.0f) {
        do {
            var_v0_2 = 0;
            var_v1_2 = var_a3_2;
loop_12:
            if ((var_a0_2 * 4) == var_v0_2) {
                var_v1_2[0][0] = 1.0f;
            } else {
                var_v1_2[0][0] = 0.0f;
            }
            var_v0_2 += 4;
            var_v1_2 += 4;
            if (var_v0_2 != 0xC) {
                goto loop_12;
            }
            var_a0_2 += 1;
            var_a3_2 += 0xC;
        } while (var_a0_2 != 3);
        arg0->unk10 = -1.0f;
        return;
    }
    temp_f0 = sqrtf((arg1 * arg1) + (arg3 * arg3));
    func_802B6A84(arg3, arg1, arg0, (s16) (s32) (f32) -(D_802B9FD0 - ((f64) (func_802B7CE8(arg2) * 180.0f) / D_802B9FC8)), -arg3 / temp_f0, 0, arg1 / temp_f0);
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B68F8.s")
#endif

#ifdef MIPS_TO_C
//generated by m2c commit 8267401fa4ef7a38942dcca43353cc1bcc6efabc
void func_802B6A84(Mat4 arg0, s16 arg1, f32 arg2, f32 arg3, f32 arg4) {
    f32 sp54;
    s32 sp34;                                       /* compiler-managed */
    f32 sp30;
    f32 sp2C;
    f32 temp_f0;
    f32 temp_f10;
    f32 temp_f12;
    f32 temp_f12_2;
    f32 temp_f14;
    f32 temp_f14_2;
    f32 temp_f16;
    f32 temp_f2;
    f32 temp_f2_2;
    f32 temp_f6;
    s32 temp_a0;

    temp_a0 = arg1 & 0xFFFF;
    sp34 = temp_a0;
    sp54 = sins((u16) temp_a0);
    temp_f0 = coss((u16) temp_a0);
    temp_f12 = arg2 * arg2;
    temp_f6 = 1.0f - temp_f0;
    arg0[0][0] = ((1.0f - temp_f12) * temp_f0) + temp_f12;
    sp34 = temp_f6;
    temp_f2 = arg3 * arg4 * temp_f6;
    temp_f14 = arg2 * sp54;
    temp_f16 = arg3 * arg3;
    arg0->unk1C = (f32) (temp_f2 - temp_f14);
    arg0->unk14 = (f32) (temp_f14 + temp_f2);
    arg0->unk10 = (f32) (((1.0f - temp_f16) * temp_f0) + temp_f16);
    sp2C = arg3 * sp54;
    temp_f10 = arg4 * arg2 * sp34;
    sp30 = temp_f10;
    arg0->unk18 = (f32) (sp2C + temp_f10);
    temp_f12_2 = arg4 * arg4;
    arg0[0][2] = sp30 - sp2C;
    arg0->unk20 = (f32) (((1.0f - temp_f12_2) * temp_f0) + temp_f12_2);
    temp_f2_2 = arg2 * arg3 * sp34;
    temp_f14_2 = arg4 * sp54;
    arg0[0][3] = temp_f2_2 - temp_f14_2;
    arg0[0][1] = temp_f14_2 + temp_f2_2;
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B6A84.s")
#endif

void func_802B6BC0(Mat4 arg0, s16 arg1, f32 arg2, f32 arg3, f32 arg4) {
    f32 sine;
    f32 cosine;
    f32 temp_f0;
    f32 temp_f12;

    sine = sins(arg1);
    cosine = coss(arg1);
    temp_f0 = sqrtf((arg2 * arg2) + (arg4 * arg4));
    if (temp_f0 != 0.0f) {
        temp_f12 = 1.0f / temp_f0;
        arg0[0][0] = ((-arg4 * cosine) - ((sine * arg3) * arg2)) * temp_f12;
        arg0[0][3] = ((arg4 * sine) - ((cosine * arg3) * arg2)) * temp_f12;
        arg0[1][2] = -arg2;
        arg0[0][1] = sine * temp_f0;
        arg0[1][0] = cosine * temp_f0;
        arg0[1][3] = -arg3;
        arg0[0][2] = ((cosine * arg2) - ((sine * arg3) * arg4)) * temp_f12;
        arg0[1][1] = ((-sine * arg2) - ((cosine * arg3) * arg4)) * temp_f12;
        arg0[2][0] = -arg4;
        arg0[0][3] = 0.0f;
        arg0[1][2] = 0.0f;
        arg0[2][1] = 0.0f;
    } else {
        arg0[0][1] = 0.0f;
        arg0[1][3] = 0.0f;
        arg0[0][2] = 0.0f;
        arg0[1][1] = 0.0f;
        arg0[0][3] = 0.0f;
        arg0[1][2] = 0.0f;
        arg0[2][1] = 0.0f;
        arg0[0][0] = 1.0f;
        arg0[1][0] = 1.0f;
        arg0[2][0] = 1.0f;
    }
}

void func_802B6D58(Mat4 arg0, Vec3f arg1, Vec3f arg2) {
    f32 sine1;
    f32 cosine1;
    f32 sine2;
    f32 cosine2;
    f32 sine3;
    f32 cosine3;

    sine1 = sins(arg2[0]);
    cosine1 = coss(arg2[0]);
    sine2 = sins(arg2[1]);
    cosine2 = coss(arg2[1]);
    sine3 = sins(arg2[2]);
    cosine3 = coss(arg2[2]);
    arg0[0][0] = (cosine2 * cosine3) + ((sine1 * sine2) * sine3);
    arg0[1][0] = (-cosine2 * sine3) + (sine1 * sine2) * cosine3;
    arg0[2][0] = cosine1 * sine2;
    arg0[3][0] = arg1[0];
    arg0[0][1] = cosine1 * sine3;
    arg0[1][1] = cosine1 * cosine3;
    arg0[2][1] = -sine1;
    arg0[3][1] = arg1[1];
    arg0[0][2] = (-sine2 * cosine3) + ((sine1 * cosine2) * sine3);
    arg0[1][2] = (sine2 * sine3) + ((sine1 * cosine2) * cosine3);
    arg0[2][2] = cosine1 * cosine2;
    arg0[3][2] = arg1[2];
    arg0[0][3] = 0.0f;
    arg0[1][3] = 0.0f;
    arg0[2][3] = 0.0f;
    arg0[3][3] = 1.0f;
}

void func_802B71CC(Mat4 arg0, Mat4 arg1, Mat4 arg2) {
    Mat4 product;
    product[0][0] = (arg1[0][0] * arg2[0][0]) + (arg1[0][1] * arg2[1][0]) + (arg1[0][2] * arg2[2][0]) + (arg1[0][3] * arg2[3][0]);
    product[0][1] = (arg1[0][0] * arg2[0][1]) + (arg1[0][1] * arg2[1][1]) + (arg1[0][2] * arg2[2][1]) + (arg1[0][3] * arg2[3][1]);
    product[0][2] = (arg1[0][0] * arg2[0][2]) + (arg1[0][1] * arg2[1][2]) + (arg1[0][2] * arg2[2][2]) + (arg1[0][3] * arg2[3][2]);
    product[0][3] = (arg1[0][0] * arg2[0][3]) + (arg1[0][1] * arg2[1][3]) + (arg1[0][2] * arg2[2][3]) + (arg1[0][3] * arg2[3][3]);
    product[1][0] = (arg1[1][0] * arg2[0][0]) + (arg1[1][1] * arg2[1][0]) + (arg1[1][2] * arg2[2][0]) + (arg1[1][3] * arg2[3][0]);
    product[1][1] = (arg1[1][0] * arg2[0][1]) + (arg1[1][1] * arg2[1][1]) + (arg1[1][2] * arg2[2][1]) + (arg1[1][3] * arg2[3][1]);
    product[1][2] = (arg1[1][0] * arg2[0][2]) + (arg1[1][1] * arg2[1][2]) + (arg1[1][2] * arg2[2][2]) + (arg1[1][3] * arg2[3][2]);
    product[1][3] = (arg1[1][0] * arg2[0][3]) + (arg1[1][1] * arg2[1][3]) + (arg1[1][2] * arg2[2][3]) + (arg1[1][3] * arg2[3][3]);
    product[2][0] = (arg1[2][0] * arg2[0][0]) + (arg1[2][1] * arg2[1][0]) + (arg1[2][2] * arg2[2][0]) + (arg1[2][3] * arg2[3][0]);
    product[2][1] = (arg1[2][0] * arg2[0][1]) + (arg1[2][1] * arg2[1][1]) + (arg1[2][2] * arg2[2][1]) + (arg1[2][3] * arg2[3][1]);
    product[2][2] = (arg1[2][0] * arg2[0][2]) + (arg1[2][1] * arg2[1][2]) + (arg1[2][2] * arg2[2][2]) + (arg1[2][3] * arg2[3][2]);
    product[2][3] = (arg1[2][0] * arg2[0][3]) + (arg1[2][1] * arg2[1][3]) + (arg1[2][2] * arg2[2][3]) + (arg1[2][3] * arg2[3][3]);
    product[3][0] = (arg1[3][0] * arg2[0][0]) + (arg1[3][1] * arg2[1][0]) + (arg1[3][2] * arg2[2][0]) + (arg1[3][3] * arg2[3][0]);
    product[3][1] = (arg1[3][0] * arg2[0][1]) + (arg1[3][1] * arg2[1][1]) + (arg1[3][2] * arg2[2][1]) + (arg1[3][3] * arg2[3][1]);
    product[3][2] = (arg1[3][0] * arg2[0][2]) + (arg1[3][1] * arg2[1][2]) + (arg1[3][2] * arg2[2][2]) + (arg1[3][3] * arg2[3][2]);
    product[3][3] = (arg1[3][0] * arg2[0][3]) + (arg1[3][1] * arg2[1][3]) + (arg1[3][2] * arg2[2][3]) + (arg1[3][3] * arg2[3][3]);
    func_802B5398(arg0, product, 0x10);
}

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
void func_802B75F8(Mtx *arg0, Mat4 arg1) {
    s32 sp14;
    Mtx *var_v0;
    f32 (*temp_a2)[4];
    f32 (*var_a2)[4];
    f32 var_f18;
    s32 *temp_v0;
    s32 *temp_v1;
    s32 *var_v1;
    s32 var_a3;

    var_v0 = arg0;
    var_v1 = arg0->m[2];
    var_a2 = arg1;
    var_a3 = 4;
    var_f18 = var_a2[0][0] * 65536.0f;
    if (4 != 0x10) {
        do {
            var_a3 += 4;
            var_a2 += 0x10;
            var_v0 += 8;
            var_v1 += 8;
            sp14 = (s32) var_f18;
            var_v0->unk-8 = (s16) sp14.unk0;
            var_v1->unk-8 = (s16) sp14.unk2;
            sp14 = (s32) (var_a2->unk-C * 65536.0f);
            var_v0->unk-6 = (s16) sp14.unk0;
            var_v1->unk-6 = (s16) sp14.unk2;
            sp14 = (s32) (var_a2->unk-8 * 65536.0f);
            var_v0->unk-4 = (s16) sp14.unk0;
            var_v1->unk-4 = (s16) sp14.unk2;
            sp14 = (s32) (var_a2->unk-4 * 65536.0f);
            var_v0->unk-2 = (s16) sp14.unk0;
            var_v1->unk-2 = (s16) sp14.unk2;
            var_f18 = var_a2[0][0] * 65536.0f;
        } while (var_a3 != 0x10);
    }
    temp_a2 = var_a2 + 0x10;
    temp_v0 = &var_v0->m[0][2];
    temp_v1 = var_v1 + 8;
    sp14 = (s32) var_f18;
    temp_v0->unk-8 = (s16) sp14.unk0;
    temp_v1->unk-8 = (s16) sp14.unk2;
    sp14 = (s32) (temp_a2->unk-C * 65536.0f);
    temp_v0->unk-6 = (s16) sp14.unk0;
    temp_v1->unk-6 = (s16) sp14.unk2;
    sp14 = (s32) (temp_a2->unk-8 * 65536.0f);
    temp_v0->unk-4 = (s16) sp14.unk0;
    temp_v1->unk-4 = (s16) sp14.unk2;
    sp14 = (s32) (temp_a2->unk-4 * 65536.0f);
    temp_v0->unk-2 = (s16) sp14.unk0;
    temp_v1->unk-2 = (s16) sp14.unk2;
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B75F8.s")
#endif

/**
 * Comment from sm64 unverified. mk64 verison is modified
 * 
 * Helper function for atan2s. Does a look up of the arctangent of y/x assuming
 * the resulting angle is in range [0, 0x2000] (1/8 of a circle).
 */
extern f32 D_802B9FD8; // = 1000000.0f;

u16 atan2_lookup(f32 y, f32 x) {
    u16 ret;

    if (x == 0) {
        ret = gArctanTable[0];
    } else {
        if (D_802B9FD8 < y / x) {
            if (y > 0.0f) {
                ret = 0x4000;
            } else {
                ret = 0xC000;
            }
        } else {
            ret = gArctanTable[(s32)(y / x * 1024 + 0.5f)];
        }
    }
    return ret;
}

/**
 * Compute the angle from (0, 0) to (x, y) as a u16. Given that terrain is in
 * the xz-plane, this is commonly called with (z, x) to get a yaw angle.
 * sm64 but x, y swapped and returns u16.
 */
u16 atan2s(f32 x, f32 y) {
    u16 ret;
    if (x >= 0) {
        if (y >= 0) {
            if (y >= x) {
                ret = atan2_lookup(x, y);
            } else {
                ret = 0x4000 - atan2_lookup(y, x);
            }
        } else {
            y = -y;
            if (y < x) {
                ret = 0x4000 + atan2_lookup(y, x);
            } else {
                ret = 0x8000 - atan2_lookup(x, y);
            }
        }
    } else {
        x = -x;
        if (y < 0) {
            y = -y;
            if (y >= x) {
                ret = 0x8000 + atan2_lookup(x, y);
            } else {
                ret = 0xC000 - atan2_lookup(y, x);
            }
        } else {
            if (y < x) {
                ret = 0xC000 + atan2_lookup(y, x);
            } else {
                ret = -atan2_lookup(x, y);
            }
        }
    }
    return ret;
}

f32 func_802B79B8(f32 arg0, f32 arg1) {
    return atan2s(arg0, arg1);
}

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
static f32 D_802B9FDC = -0.01600503f;
static f32 D_802B9FE0 = 0.00283406f;
static f32 D_802B9FE4 = -0.07495445f;
static f32 D_802B9FE8 = 0.04258761f;
static f32 D_802B9FEC = -0.14202571f;
static f32 D_802B9FF0 = 0.10636754f;
static f32 D_802B9FF4 = -0.33333066f;
static f32 D_802B9FF8 = 0.19992484f;
static f64 D_802BA000 = 1.5707963267948966;
static f64 D_802BA008 = 1.5707963267948966;
static f32 D_802BA010 = 3.1415927f;

f32 func_802B79F0(f32 arg0, f32 arg1) {
    f32 temp_f0;
    f32 temp_f14;
    f32 temp_f16;
    f32 temp_f2;
    f32 var_f16;
    f32 var_f2;
    s32 var_v0;

    var_f16 = arg0 / arg1;
    var_v0 = 0;
    if (fabs((f64) arg1) < fabs((f64) arg0)) {
        var_v0 = 1;
    }
    if (var_v0 != 0) {
        var_f16 = arg1 / arg0;
    }
    temp_f0 = var_f16 * var_f16;
    temp_f2 = temp_f0 * temp_f0;
    temp_f16 = var_f16 + (((((temp_f2 * (D_802B9FDC + (temp_f0 * D_802B9FE0))) + D_802B9FE4 + (temp_f0 * D_802B9FE8)) * (temp_f2 * temp_f2)) + ((D_802B9FEC + (temp_f0 * D_802B9FF0)) * temp_f2) + D_802B9FF4 + (temp_f0 * D_802B9FF8)) * (var_f16 * temp_f0));
    if (var_v0 != 0) {
        if (arg0 < 0.0f) {
            return (f32) (-D_802BA000 - (f64) temp_f16);
        }
        return (f32) (D_802BA008 - (f64) temp_f16);
    }
    if (arg1 >= 0.0f) {
        return temp_f16;
    }
    temp_f14 = D_802BA010;
    var_f2 = temp_f16 + temp_f14;
    if (arg0 < 0.0f) {
        var_f2 = temp_f16 - temp_f14;
    }
    return var_f2;
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B79F0.s")
#endif

extern f64 D_802BA018; // = 3.141592653589793;

UNUSED u16 func_802B7B50(f32 arg0, f32 arg1) {
    return ((func_802B79B8(arg0, arg1) * 32768.0f) / D_802BA018);
}

UNUSED void func_802B7C18(f32 arg0) {
    func_802B79B8(arg0, 1.0f);
}

s16 func_802B7C40(f32 arg0) {
    return atan2s(arg0, 1.0f);
}

UNUSED void func_802B7C6C(f32 arg0) {
    func_802B79B8(arg0, sqrtf(1.0 - (arg0 * arg0)));
}

s16 func_802B7CA8(f32 arg0) {
    return atan2s(arg0, sqrtf(1.0 - (arg0 * arg0)));
}

f32 func_802B7CE8(f32 arg0) {
    return func_802B79B8(sqrtf(1.0 - (arg0 * arg0)), arg0);
}

UNUSED s16 func_802B7D28(f32 arg0) {
    return func_802B79B8(sqrtf(1.0 - (f64)(arg0 * arg0)), arg0) * 32768.0f / 3.141592653589793;
}

//extern u16 gRandomSeed16;

u16 random_u16(void) {
    u16 temp1, temp2;

    if (gRandomSeed16 == 22026) {
        gRandomSeed16 = 0;
    }

    temp1 = (gRandomSeed16 & 0x00FF) << 8;
    temp1 = temp1 ^ gRandomSeed16;

    gRandomSeed16 = ((temp1 & 0x00FF) << 8) + ((temp1 & 0xFF00) >> 8);

    temp1 = ((temp1 & 0x00FF) << 1) ^ gRandomSeed16;
    temp2 = (temp1 >> 1) ^ 0xFF80;

    if ((temp1 & 1) == 0) {
        if (temp2 == 43605) {
            gRandomSeed16 = 0;
        } else {
            gRandomSeed16 = temp2 ^ 0x1FF4;
        }
    } else {
        gRandomSeed16 = temp2 ^ 0x8180;
    }

    return gRandomSeed16;
}

u16 random_int(u16 arg0) {
    return arg0 * (( (f32) random_u16() )  / 65535.0);
}
s16 func_802B7F34(f32 arg0, f32 arg1, f32 arg2, f32 arg3) {
    return atan2s(arg2 - arg0, arg3 - arg1);
}

void func_802B7F7C(Vec3f arg0, Vec3f arg1, Vec3s arg2) {
    f32 temp_f14 = arg0[0];
    f32 sp28 = arg0[1];
    f32 temp_f12 = arg0[2];

    f32 temp_f2 = arg1[0];
    f32 sp1C = arg1[1];
    f32 temp_f0 = arg1[2];

    arg2[1] = func_802B7F34(temp_f12, temp_f14, temp_f0, temp_f2);
    arg2[0] = func_802B7F34(sp28, temp_f12, sp1C, temp_f0);
    arg2[2] = func_802B7F34(temp_f14, sp28, temp_f2, sp1C);
}

f32 sins(u16 arg0) {
    return gSineTable[arg0 >> 4];
}

f32 coss(u16 arg0) {
    return gCosineTable[arg0 >> 4];
}

s32 func_802B8058(u16 arg0, u16 arg1, u16 arg2) {
    if (arg1 < arg0) {
        if (arg1 >= arg2) {
            return 0;
        }
        if (arg2 >= arg0) {
            return 0;
        }
    } else {
        if ((arg1 >= arg2) && (arg2 >= arg0)) {
            return 0;
        }
    }
    return 1;
}

#ifdef MIPS_TO_C
//generated by m2c commit 3b40ab93768f52ac241c5ae84ef58ef6bc4cb1de
f32 func_802B80D0(Vec3f arg0, Vec3f arg1, u16 arg2, f32 arg3, f32 arg4, f32 arg5) {
    u16 sp5E;
    s16 sp5A;
    s32 sp28;
    s32 sp24;
    s32 sp20;
    f32 temp_f0;
    f32 temp_f0_2;
    f32 temp_f20;
    f32 temp_f2;
    f32 temp_f2_2;
    s16 temp_v0;
    s32 temp_t6;
    s32 temp_t7;
    s32 temp_v1;
    s32 temp_v1_2;
    u16 temp_a2;

    temp_f0 = arg1->unk0 - arg0->unk0;
    temp_f0_2 = temp_f0 * temp_f0;
    if (arg5 < temp_f0_2) {
        return -1.0f;
    }
    temp_f2 = arg1->unk8 - arg0->unk8;
    temp_f2_2 = temp_f2 * temp_f2;
    if (arg5 < temp_f2_2) {
        return -1.0f;
    }
    temp_f20 = temp_f0_2 + temp_f2_2;
    if (temp_f20 < arg3) {
        return temp_f20;
    }
    if (arg5 < temp_f20) {
        return -1.0f;
    }
    arg2 = arg2;
    temp_a2 = func_802B5224(arg0, arg1) & 0xFFFF;
    if (arg3 == 0.0f) {
        temp_v1 = ((u32) arg4 * 0xB6) & 0xFFFF;
        if (func_802B8058((arg2 + temp_v1) & 0xFFFF, (arg2 - temp_v1) & 0xFFFF, temp_a2) == 1) {
            return temp_f20;
        }
        return -1.0f;
    }
    temp_v1_2 = ((u32) arg4 * 0xB6) & 0xFFFF;
    temp_t7 = (arg2 - temp_v1_2) & 0xFFFF;
    temp_t6 = (arg2 + temp_v1_2) & 0xFFFF;
    sp24 = temp_t6;
    sp20 = temp_t7;
    sp5E = temp_a2;
    if (func_802B8058((u16) temp_t6, (u16) temp_t7, temp_a2) == 1) {
        return temp_f20;
    }
    temp_v0 = func_802B7CA8(arg3 / temp_f20);
    sp5A = temp_v0;
    sp28 = (s32) sp5E;
    if (func_802B8058(unksp26, unksp22, (sp5E + temp_v0) & 0xFFFF) == 1) {
        return temp_f20;
    }
    if (func_802B8058(unksp26, unksp22, (sp5E - (u16) sp5A) & 0xFFFF) == 1) {
        return temp_f20;
    }
    return -1.0f;
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B80D0.s")
#endif

#ifdef MIPS_TO_C
//generated by mips_to_c commit bd0364fa19633bd6201f8007e2d0a7ed87825909
//This function did not have a glabel in the original assembly, as such it may
//be unused/unnamed
f32 sins(s32);                               /* extern */
f32 coss(s32);                               /* extern */
extern uintptr_t gSegmentTable;

void func_802B8414(u32 arg0, void *arg1, u16 arg2, s32 arg3, s32 arg4) {
    f32 sp48;
    f32 sp44;
    f32 sp40;
    s8 sp3E;
    s8 sp3D;
    s8 sp3C;
    s32 sp20;
    s32 temp_a0;
    s32 temp_a1;
    s32 temp_v0;
    s32 temp_v0_2;
    void *temp_s0;
    void *temp_s0_2;
    void *temp_s0_3;
    void *phi_s0;
    s32 phi_v0;
    void *phi_s0_2;
    s32 phi_v0_2;

    temp_a0 = arg3 & 0xFFFF;
    temp_s0 = *(&gSegmentTable + ((arg0 >> 0x18) * 4)) + (arg0 & 0xFFFFFF) + 0x80000000;
    sp20 = temp_a0;
    sins(temp_a0);
    coss(temp_a0);
    sp20 = arg2;
    sins(arg2);
    coss(arg2);
    sp40 = 0.0f;
    sp44 = 0.0f;
    sp48 = 1.0f;
    temp_a1 = arg4 & 3;
    sp3C = ((arg1->unk20 * 1.0f) + ((sp40 * arg1->unk0) + (sp44 * arg1->unk10))) * 127.0f;
    sp3D = ((arg1->unk24 * 1.0f) + ((sp40 * arg1->unk4) + (sp44 * arg1->unk14))) * 127.0f;
    sp3E = ((arg1->unk28 * 1.0f) + ((sp40 * arg1->unk8) + (sp44 * arg1->unk18))) * 127.0f;
    phi_v0 = 0;
    phi_v0_2 = 0;
    if (arg4 > 0) {
        phi_s0 = temp_s0;
        phi_s0_2 = temp_s0;
        if (temp_a1 != 0) {
            do {
                temp_v0 = phi_v0 + 1;
                temp_s0_2 = phi_s0 + 0x18;
                temp_s0_2->unk-8 = sp3C;
                temp_s0_2->unk-7 = sp3D;
                temp_s0_2->unk-6 = sp3E;
                phi_s0 = temp_s0_2;
                phi_v0 = temp_v0;
                phi_s0_2 = temp_s0_2;
                phi_v0_2 = temp_v0;
            } while (temp_a1 != temp_v0);
            if (temp_v0 != arg4) {
                goto loop_4;
            }
        } else {
            do {
loop_4:
                temp_v0_2 = phi_v0_2 + 4;
                temp_s0_3 = phi_s0_2 + 0x60;
                temp_s0_3->unk-50 = sp3C;
                temp_s0_3->unk-4F = sp3D;
                temp_s0_3->unk-4E = sp3E;
                temp_s0_3->unk-38 = sp3C;
                temp_s0_3->unk-37 = sp3D;
                temp_s0_3->unk-36 = sp3E;
                temp_s0_3->unk-20 = sp3C;
                temp_s0_3->unk-1F = sp3D;
                temp_s0_3->unk-1E = sp3E;
                temp_s0_3->unk-8 = sp3C;
                temp_s0_3->unk-7 = sp3D;
                temp_s0_3->unk-6 = sp3E;
                phi_s0_2 = temp_s0_3;
                phi_v0_2 = temp_v0_2;
            } while (temp_v0_2 != arg4);
        }
    }
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B8414.s")
#endif

#ifdef MIPS_TO_C
//generated by mips_to_c commit 792017ad9d422c2467bd42686f383a5c41f41c75
UNUSED void func_802B8614(Player *player) {
    f64 sp78;
    f64 sp70;
    f64 sp68;
    f64 sp58;
    f64 sp50;
    f64 sp48;
    f64 sp40;
    f64 sp38;
    f64 temp_f12;
    f64 temp_f14;
    f64 temp_f16;
    f64 temp_f18;
    f64 temp_f20;
    f64 temp_f2;
    f64 temp_f30;
    f64 temp_f4;
    f64 temp_f6;

    temp_f6 = (f64) player->boundingBoxCorners[1].cornerPos[0];
    sp70 = (f64) player->boundingBoxCorners[1].cornerGroundY;
    sp68 = (f64) player->boundingBoxCorners[1].cornerPos[2];
    temp_f30 = (f64) player->boundingBoxCorners[0].cornerPos[0];
    sp58 = (f64) player->boundingBoxCorners[0].cornerGroundY;
    sp50 = (f64) player->boundingBoxCorners[0].cornerPos[2];
    sp48 = (f64) player->boundingBoxCorners[3].cornerPos[0];
    sp40 = (f64) player->boundingBoxCorners[3].cornerGroundY;
    temp_f4 = (f64) player->boundingBoxCorners[3].cornerPos[2];
    temp_f2 = sp58 - sp70;
    sp38 = temp_f4;
    temp_f12 = temp_f4 - sp50;
    temp_f14 = sp50 - sp68;
    temp_f16 = sp40 - sp58;
    temp_f18 = sp48 - temp_f30;
    temp_f20 = temp_f30 - temp_f6;
    if (0.0 == 0.0) {
        player->unk_058 = 0.0f;
        player->unk_060 = 0.0f;
        player->unk_05C = 1.0f;
        return;
    }
    player->unk_058 = (f32) ((f64) (f32) ((temp_f2 * temp_f12) - (temp_f14 * temp_f16)) / 0.0);
    player->unk_05C = (f32) ((f64) (f32) ((temp_f14 * temp_f18) - (temp_f20 * temp_f12)) / 0.0);
    player->unk_060 = (f32) ((f64) (f32) ((temp_f20 * temp_f16) - (temp_f2 * temp_f18)) / 0.0);
}
#else
GLOBAL_ASM("asm/non_matchings/math_util/func_802B8614.s")
#endif