#include <ultra64.h>
#include <macros.h>
#include <mk64.h>
#include <course.h>

#include "math_util.h"
#include <common_structs.h>
#include "player_controller.h"
#include "effects.h"
#include "code_8003DC40.h"
#include "defines.h"

void func_8003DC40(Player* player) {
    player->unk_DAC = 1.0f;
}

UNUSED void func_8003DC50(Player* player, Vec3f arg1) {
    s32 thing1 = 0;
    s32 thing2 = 0;
    // Praise Fake Match!!
    if (player) {};
    if (player->unk_230 <= player->unk_23C) {
        if (player->collision.unk48[1] >= 0.1736) {
            arg1[0] = (player->unk_206 / 182) * 0x78;
            arg1[2] = -(player->slopeAccel / 182) * 0x78;
        } else {
            arg1[0] = thing1;
            arg1[2] = thing2;
        }
    } else if (player->collision.unk48[1] >= 0.1736) {
        arg1[0] = (player->unk_206 / 182) * 0x78;
        arg1[2] = -(player->slopeAccel / 182) * 0x78;
    } else {
        arg1[0] = thing1;
        arg1[2] = thing2;
    }
    arg1[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg1, player->orientationMatrix);
}

UNUSED void func_8003DE4C(Player* player, Vec3f arg1) {
    s32 thing1 = 0;
    s32 thing2 = 0;
    // Praise Fake Match!!
    if (player) {};
    if (player->unk_230 <= player->unk_23C) {
        if (player->collision.unk54[1] >= 0.1736) {
            arg1[0] = (player->unk_206 / 182) * 0x78;
            arg1[2] = -(player->slopeAccel / 182) * 0x78;
        } else {
            arg1[0] = thing1;
            arg1[2] = thing2;
        }
    } else if (player->collision.unk54[1] >= 0.1736) {
        arg1[0] = (player->unk_206 / 182) * 0x78;
        arg1[2] = -(player->slopeAccel / 182) * 0x78;
    } else {
        arg1[0] = thing1;
        arg1[2] = thing2;
    }
    arg1[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg1, player->orientationMatrix);
}

// Stick to ground?
void func_8003E048(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
    *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 0.1;
    *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
    func_8002A5F4(arg1, *arg4, arg2, 1, 2);
    if (player->collision.orientationVector[1] <= 0.8829f) {
        arg3[0] = ((player->unk_206 / 182) * 0xB4);
        arg3[2] = (-(player->slopeAccel / 182) * 0xB4);
        player_decelerate_alternative(player, 4.0f);
        player->unk_DAC = 0.5f;
        if ((player->effects & BOOST_EFFECT) != 0) {
            remove_boost_effect(player);
            player->currentSpeed /= 2;
            player->unk_08C /= 2;
        }
    } else if ((((player->speed / 18.0f) * 216.0f) > 20.0f) ||
               ((player->effects & UNKNOWN_EFFECT_0x10000) == UNKNOWN_EFFECT_0x10000)) {
        arg3[0] = ((player->unk_206 / 182) * 0x32);
        arg3[2] = (-(player->slopeAccel / 182) * 0x3C);
    } else {
        arg3[0] = 0.0f;
        arg3[2] = (-(player->slopeAccel / 182) * 0x32);
    }
    arg3[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg3, player->orientationMatrix);
}

void func_8003E37C(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
    *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 0.2;
    *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
    func_8002A5F4(arg1, *arg4, arg2, 0.5f, 2);
    if ((player->collision.orientationVector[1] <= 0.7318f) || (player->surfaceType == CLIFF)) {
        arg3[0] = ((player->unk_206 / 182) * 0xB4);
        arg3[2] = (-(player->slopeAccel / 182) * 0xB4);
        if (((player->speed / 18.0f) * 216.0f) >= 8.0f) {
            player_decelerate_alternative(player, 5.0f);
        }
        player->unk_DAC = 0.5f;
        if ((player->effects & BOOST_EFFECT) != 0) {
            remove_boost_effect(player);
            player->currentSpeed /= 2;
            player->unk_08C /= 2;
        }
    } else if ((((player->speed / 18.0f) * 216.0f) > 20.0f) ||
               ((player->effects & UNKNOWN_EFFECT_0x10000) == UNKNOWN_EFFECT_0x10000)) {
        arg3[0] = ((player->unk_206 / 182) * 0x32);
        arg3[2] = (-(player->slopeAccel / 182) * 0x32);
    } else {
        arg3[0] = 0.0f;
        arg3[2] = (-(player->slopeAccel / 182) * 0x32);
    }
    arg3[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg3, player->orientationMatrix);
}

void func_8003E6EC(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
    *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 0.1;
    *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
    func_8002A5F4(arg1, *arg4, arg2, 0.5f, 2);
    if (player->collision.orientationVector[1] <= 0.8829f) {
        arg3[0] = ((player->unk_206 / 182) * 0xB4);
        arg3[2] = (-(player->slopeAccel / 182) * 0xB4);
        player_decelerate_alternative(player, 4.0f);
        func_8003DC40(player);
    } else if ((((player->speed / 18.0f) * 216.0f) > 20.0f) ||
               ((player->effects & UNKNOWN_EFFECT_0x10000) == UNKNOWN_EFFECT_0x10000)) {
        arg3[0] = ((player->unk_206 / 182) * 0x32);
        arg3[2] = (-(player->slopeAccel / 182) * 0x3C);
    } else {
        arg3[0] = 0.0f;
        arg3[2] = (-(player->slopeAccel / 182) * 0x32);
    }
    arg3[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg3, player->orientationMatrix);
}

void func_8003E9EC(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
    *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 0.1;
    *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
    func_8002A5F4(arg1, *arg4, arg2, 1.2f, 2);
    if (player->collision.orientationVector[1] <= 0.8357f) {
        arg3[0] = ((player->unk_206 / 182) * 0x78);
        arg3[2] = (-(player->slopeAccel / 182) * 0xB4);
        player_decelerate_alternative(player, 4.0f);
        func_8003DC40(player);
    } else {
        if ((((player->speed / 18.0f) * 216.0f) > 20.0f) ||
            ((player->effects & UNKNOWN_EFFECT_0x10000) == UNKNOWN_EFFECT_0x10000)) {
            if ((player->tyres[BACK_LEFT].surfaceType == ASPHALT) ||
                (player->tyres[BACK_RIGHT].surfaceType == ASPHALT) ||
                (player->tyres[FRONT_RIGHT].surfaceType == ASPHALT) ||
                (player->tyres[FRONT_LEFT].surfaceType == ASPHALT)) {
                arg3[0] = ((player->unk_206 / 182) * 5);
            } else {
                arg3[0] = ((player->unk_206 / 182) * 0x28);
            }
            arg3[2] = (-(player->slopeAccel / 182) * 0x28);
        } else {
            arg3[0] = 0.0f;
            arg3[2] = (-(player->slopeAccel / 182) * 0x32);
        }
        if ((player->effects & UNKNOWN_EFFECT_0x10000) != 0) {
            arg3[0] = ((player->unk_206 / 182) * 0x78);
            arg3[2] = (-(player->slopeAccel / 182) * 0xB4);
        }
    }
    arg3[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg3, player->orientationMatrix);
}

void func_8003EE2C(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
    *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 0.1;
    *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
    func_8002A5F4(arg1, *arg4, arg2, 0.5f, 2);
    if (player->collision.orientationVector[1] <= 0.8357f) {
        arg3[0] = ((player->unk_206 / 182) * 0x78);
        arg3[2] = (-(player->slopeAccel / 182) * 0xB4);
        player_decelerate_alternative(player, 4.0f);
        func_8003DC40(player);
    } else if ((((player->speed / 18.0f) * 216.0f) > 20.0f) ||
               ((player->effects & UNKNOWN_EFFECT_0x10000) == UNKNOWN_EFFECT_0x10000)) {
        arg3[0] = ((player->unk_206 / 182) * 0x32);
        arg3[2] = (-(player->slopeAccel / 182) * 0x3C);
    } else {
        arg3[0] = 0.0f;
        arg3[2] = (-(player->slopeAccel / 182) * 0x32);
    }
    arg3[1] = 0.0f;
    mtxf_transform_vec3f_mat3(arg3, player->orientationMatrix);
}

void func_8003F138(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
    *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 0.1;
    *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
    func_8002A5F4(arg1, *arg4, arg2, 0.5f, 2);
    if (player->surfaceType == GRASS) {
        player->unk_044 &= ~1;
    }
    if (player->collision.orientationVector[1] <= 0.8357f) {
        arg3[0] = ((player->unk_206 / 182) * 0xC8);
        arg3[2] = (-(player->slopeAccel / 182) * 0xC8);
        player_decelerate_alternative(player, 4.0f);
        player->unk_DAC = 0.5f;
        arg3[0] = 0;
    } else if ((((player->speed / 18.0f) * 216.0f) > 20.0f) ||
               ((player->effects & UNKNOWN_EFFECT_0x10000) == UNKNOWN_EFFECT_0x10000)) {
        arg3[0] = ((player->unk_206 / 182) * 0x78);
        arg3[2] = (-(player->slopeAccel / 182) * 0x78);
        arg3[0] = 0;
    } else {
        arg3[0] = 0.0f;
        arg3[2] = (-(player->slopeAccel / 182) * 0x32);
    }
    arg3[1] = 0.0f;
    arg3[2] = 0.0f;
    mtxf_transform_vec3f_mat3(arg3, player->orientationMatrix);
}

void func_8003F46C(Player* player, Vec3f arg1, Vec3f arg2, Vec3f arg3, f32* arg4, f32* arg5, f32* arg6, f32* arg7) {
    arg1[0] = -player->collision.orientationVector[0];
    arg1[1] = -player->collision.orientationVector[1];
    arg1[2] = -player->collision.orientationVector[2];
    if ((player->collision.orientationVector[1] < 0.0f) && ((player->unk_0CA & 2) == 0)) {
        *arg5 += arg1[0] * player->collision.surfaceDistance[2] * 1;
        *arg6 += arg1[1] * player->collision.surfaceDistance[2] * 1;
        *arg7 += arg1[2] * player->collision.surfaceDistance[2] * 1;
        func_8002A5F4(arg1, *arg4, arg2, 1.2f, 0.0f);
        player->kartHopJerk = 0.0f;
        player->kartHopAcceleration = 0.0f;
        player->kartHopVelocity = 0.0f;
        return;
    } else {
#if !ENABLE_CUSTOM_COURSE_ENGINE
        switch (gCurrentCourseId) {
            case COURSE_MARIO_RACEWAY:
                func_8003E048(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
            case COURSE_CHOCO_MOUNTAIN:
            case COURSE_KOOPA_BEACH:
                func_8003E37C(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
            case COURSE_BOWSER_CASTLE:
                func_8003E6EC(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
            case COURSE_LUIGI_RACEWAY:
                func_8003E9EC(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
            case COURSE_WARIO_STADIUM:
                func_8003EE2C(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
            case COURSE_DK_JUNGLE:
                func_8003F138(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
            default:
                func_8003E048(player, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
                break;
        }
#else

#endif
        if (player->effects & UNKNOWN_EFFECT_0x10000) {
            player->unk_DAC = 0.5f;
        }
    }
}

void func_8003F734(Player* player, Vec3f arg1, Vec3f arg2, f32* arg3, f32* arg4, f32* arg5, f32* arg6) {
    f32 temp_f12;
    f32 temp_f14;
    f32 temp_f0_2;

    arg1[0] = -player->collision.unk48[0];
    arg1[1] = -player->collision.unk48[1];
    arg1[2] = -player->collision.unk48[2];
    if (player->collision.unk48[1] == 0) {
        *arg4 += arg1[0] * player->collision.surfaceDistance[0] * 1;
        *arg5 += arg1[1] * player->collision.surfaceDistance[0] * 0.1;
        *arg6 += arg1[2] * player->collision.surfaceDistance[0] * 1;
        if ((player->slopeAccel < 0) && (((player->speed / 18.0f) * 216.0f) < 10.0f)) {
            func_8002A5F4(arg1, *arg3, arg2, 2.5f, 0);
        } else {
            func_8002A5F4(arg1, *arg3, arg2, 0.5f, 0);
        }
    } else if (player->collision.unk48[1] <= 0.5) {
        *arg4 += arg1[0] * player->collision.surfaceDistance[0] * 1;
        *arg5 += arg1[1] * player->collision.surfaceDistance[0] * 0.1;
        *arg6 += arg1[2] * player->collision.surfaceDistance[0] * 1;
        func_8002A5F4(arg1, *arg3, arg2, 1, 0);
        if ((!(player->effects & UNKNOWN_EFFECT_0x10000)) && ((player->effects & 8) == 0)) {
            arg2[1] *= -1e-05;
        }
    } else {
        *arg4 += arg1[0] * player->collision.surfaceDistance[0] * 1;
        temp_f0_2 = player->collision.surfaceDistance[0] * arg1[1];
        if (temp_f0_2 < 0) {
            *arg5 += temp_f0_2 * 0.1;
        } else {
            *arg5 += temp_f0_2 * 0;
        }
        *arg6 += arg1[2] * player->collision.surfaceDistance[0] * 1;
        func_8002A5F4(arg1, *arg3, arg2, 1.2f, 0);
        if ((!(player->effects & UNKNOWN_EFFECT_0x10000)) && ((player->effects & 8) == 0)) {
            arg2[1] *= -1e-05;
        }
    }
    player->effects &= ~0x10;
    temp_f12 = player->collision.surfaceDistance[0] * arg1[0];
    temp_f14 = player->collision.surfaceDistance[0] * arg1[2];
    if (((temp_f12 >= 0) && (temp_f14 >= 0)) || ((temp_f12 < 0) && (temp_f14 >= 0))) {
        temp_f0_2 = player->boundingBoxSize / 2;
        player->unk_218 = *arg4 - temp_f12 - temp_f0_2;
        player->unk_21C = *arg6 - temp_f14 - temp_f0_2;
    }
    if (((temp_f12 < 0) && (temp_f14 < 0)) || ((temp_f12 >= 0) && (temp_f14 < 0))) {
        temp_f0_2 = player->boundingBoxSize / 2;
        player->unk_218 = *arg4 + temp_f12 + temp_f0_2;
        player->unk_21C = *arg6 + temp_f14 + temp_f0_2;
    }
}

void func_8003FBAC(Player* player, Vec3f arg1, Vec3f arg2, f32* arg3, f32* arg4, f32* arg5, f32* arg6) {
    f32 temp_f0_2;
    f32 temp_f12;
    f32 temp_f14;

    arg1[0] = -player->collision.unk54[0];
    arg1[1] = -player->collision.unk54[1];
    arg1[2] = -player->collision.unk54[2];
    if (player->collision.unk54[1] == 0) {
        *arg4 += arg1[0] * player->collision.surfaceDistance[1] * 1;
        *arg5 += arg1[1] * player->collision.surfaceDistance[1] * 0.1;
        *arg6 += arg1[2] * player->collision.surfaceDistance[1] * 1;
        if ((player->slopeAccel < 0) && (((player->speed / 18.0f) * 216.0f) < 10.0f)) {
            func_8002A5F4(arg1, *arg3, arg2, 1.5f, 0);
        } else {
            func_8002A5F4(arg1, *arg3, arg2, 0.5f, 0);
        }
    } else if (player->collision.unk54[1] <= 0.5) {
        *arg4 += arg1[0] * player->collision.surfaceDistance[1] * 1;
        *arg5 += arg1[1] * player->collision.surfaceDistance[1] * 0.1;
        *arg6 += arg1[2] * player->collision.surfaceDistance[1] * 1;
        func_8002A5F4(arg1, *arg3, arg2, 1, 0);
        if ((!(player->effects & UNKNOWN_EFFECT_0x10000)) && ((player->effects & 8) == 0)) {
            arg2[1] *= -1e-05;
        }
    } else {
        *arg4 += arg1[0] * player->collision.surfaceDistance[1] * 1;
        temp_f0_2 = player->collision.surfaceDistance[1] * arg1[1];
        if (temp_f0_2 < 0) {
            *arg5 += temp_f0_2 * 0.1;
        } else {
            *arg5 += temp_f0_2 * 0;
        }
        *arg6 += arg1[2] * player->collision.surfaceDistance[1] * 1;
        func_8002A5F4(arg1, *arg3, arg2, 1.2f, 0);
        if ((!(player->effects & UNKNOWN_EFFECT_0x10000)) && ((player->effects & 8) == 0)) {
            arg2[1] *= -1e-05;
        }
    }
    player->effects &= ~0x10;
    temp_f12 = player->collision.surfaceDistance[1] * arg1[0];
    temp_f14 = player->collision.surfaceDistance[1] * arg1[2];
    if (((temp_f12 >= 0) && (temp_f14 >= 0)) || ((temp_f12 >= 0) && (temp_f14 < 0))) {
        temp_f0_2 = player->boundingBoxSize / 2;
        player->unk_218 = *arg4 - temp_f12 - temp_f0_2;
        player->unk_21C = *arg6 - temp_f14 - temp_f0_2;
    }
    if (((temp_f12 < 0) && (temp_f14 >= 0)) || ((temp_f12 < 0) && (temp_f14 < 0))) {
        temp_f0_2 = player->boundingBoxSize / 2;
        player->unk_218 = *arg4 + temp_f12 + temp_f0_2;
        player->unk_21C = *arg6 + temp_f14 + temp_f0_2;
    }
}