//
// Generated by dtk
// Translation Unit: d_bg_w.cpp
//

#include "d/d_bg_w.h"
#include "d/d_bg_s.h"
#include "d/d_bg_s_acch.h"
#include "d/d_bg_s_sph_chk.h"
#include "SSystem/SComponent/c_m2d.h"
#include "SSystem/SComponent/c_math.h"

#define CHECK_FLOAT_CLASS(line, x) JUT_ASSERT(line, !(fpclassify(x) == 1));

/* 800A5C3C-800A5CA8       .text __ct__4dBgWFv */
dBgW::dBgW() {
    mRotYDelta = 0;
    mOldRotY = 0;
    m_crr_func = NULL;
    mpRideCb = NULL;
    mpPushPullCb = NULL;
    mFlag = 0;
    mRoomNo = 0xFFFF;
    mRoomNo2 = 0xFF;
}

/* 800A5CA8-800A5CD4       .text Move__4dBgWFv */
void dBgW::Move() {
    mFlag |= 0x01;
    cBgW::Move();
}

/* 800A5CD4-800A5E64       .text positionWallCorrect__4dBgWFP9dBgS_AcchfR8cM3dGPlaP4cXyzf */
void dBgW::positionWallCorrect(dBgS_Acch* acch, f32 dist, cM3dGPla& plane, cXyz* pupper_pos, f32 speed) {
    acch->SetWallHit();
    f32 move = speed * dist;
    pupper_pos->x += move * plane.mNormal.x;
    pupper_pos->z += move * plane.mNormal.z;
    CHECK_FLOAT_CLASS(0xd0, pupper_pos->x);
    CHECK_FLOAT_CLASS(0xd1, pupper_pos->z);
}

/* 800A5E64-800A6DF8       .text RwgWallCorrect__4dBgWFP9dBgS_AcchUs */
bool dBgW::RwgWallCorrect(dBgS_Acch* pwi, u16 i_poly_idx) {
    bool correct = false;

    while (true) {
        cBgW_RwgElm* rwg_elm = &pm_rwg[i_poly_idx];

        if (!ChkPolyThrough(i_poly_idx, pwi->GetPolyPassChk())) {
            cBgW_TriElm* tri = &pm_tri[i_poly_idx];

            f32 sp68 = std::sqrtf(SQUARE(tri->m_plane.GetNP()->x) + SQUARE(tri->m_plane.GetNP()->z));
            if (cM3d_IsZero(sp68)) {
                if (rwg_elm->next != 0xFFFF) {
                    i_poly_idx = rwg_elm->next;
                    continue;
                }
                break;
            }

            f32 sp6C = 1.0f / sp68;
            cBgD_Tri_t* tri_data = &pm_bgd->m_t_tbl[i_poly_idx];
            int cir_index = 0;

            while (cir_index < pwi->GetTblSize()) {
                f32 sp78 = sp6C * pwi->GetWallR(cir_index);
                Vec sp50;
                sp50.x = sp78 * tri->m_plane.GetNP()->x;
                sp50.y = 0.0f;
                sp50.z = sp78 * tri->m_plane.GetNP()->z;

                f32 sp7C;
                if (!pwi->ChkWallHDirect(cir_index)) {
                    sp7C =
                        (pwi->GetWallAddY(sp50, cir_index) + (pwi->GetPos()->y + pwi->GetWallH(cir_index))) -
                        pwi->GetSpeedY();
                } else {
                    sp7C = pwi->GetWallHDirect(cir_index);
                }

                f32 sp5C[3];
                sp5C[0] = pm_vtx_tbl[tri_data->vtx0].y - sp7C;
                sp5C[1] = pm_vtx_tbl[tri_data->vtx1].y - sp7C;
                sp5C[2] = pm_vtx_tbl[tri_data->vtx2].y - sp7C;

                if ((!(sp5C[0] > 0.0f) || !(sp5C[1] > 0.0f) || !(sp5C[2] > 0.0f)) &&
                    (!(sp5C[0] < 0.0f) || !(sp5C[1] < 0.0f) || !(sp5C[2] < 0.0f)))
                {
                    int sp8C = 0;
                    if (cM3d_IsZero(sp5C[0])) {
                        sp8C++;
                    }
                    if (cM3d_IsZero(sp5C[1])) {
                        sp8C++;
                    }
                    if (cM3d_IsZero(sp5C[2])) {
                        sp8C++;
                    }

                    int sp80, sp84, sp88;
                    if (sp8C != 1) {
                        if ((sp5C[0] > 0.0f && (sp5C[1] <= 0.0f) && (sp5C[2] <= 0.0f)) ||
                            (sp5C[0] < 0.0f && (sp5C[1] >= 0.0f) && (sp5C[2] >= 0.0f)))
                        {
                            sp80 = 0;
                            sp84 = 1;
                            sp88 = 2;
                        } else if ((sp5C[1] > 0.0f && (sp5C[0] <= 0.0f) && (sp5C[2] <= 0.0f)) ||
                                   (sp5C[1] < 0.0f && (sp5C[0] >= 0.0f) && (sp5C[2] >= 0.0f)))
                        {
                            sp80 = 1;
                            sp84 = 0;
                            sp88 = 2;
                        } else {
                            sp80 = 2;
                            sp84 = 0;
                            sp88 = 1;
                        }

                        f32 sp90 = sp5C[sp80] - sp5C[sp84];
                        f32 sp94 = sp5C[sp80] - sp5C[sp88];
                        if (!cM3d_IsZero(sp90) && !cM3d_IsZero(sp94)) {
                            f32 sp98 = -sp5C[sp84] / sp90;
                            f32 sp9C = -sp5C[sp88] / sp94;

                            f32 vtx0_x = pm_vtx_tbl[tri_data->vtx0].x;
                            f32 vtx0_z = pm_vtx_tbl[tri_data->vtx0].z;
                            f32 vtx1_x = pm_vtx_tbl[tri_data->vtx1].x;
                            f32 vtx1_z = pm_vtx_tbl[tri_data->vtx1].z;
                            f32 vtx2_x = pm_vtx_tbl[tri_data->vtx2].x;
                            f32 vtx2_z = pm_vtx_tbl[tri_data->vtx2].z;

                            f32 cx0, cy0, cx1, cy1;
                            if (sp80 == 0) {
                                cx0 = vtx1_x + sp98 * (vtx0_x - vtx1_x);
                                cy0 = vtx1_z + sp98 * (vtx0_z - vtx1_z);
                                cx1 = vtx2_x + sp9C * (vtx0_x - vtx2_x);
                                cy1 = vtx2_z + sp9C * (vtx0_z - vtx2_z);
                            } else if (sp80 == 1) {
                                cx0 = vtx0_x + sp98 * (vtx1_x - vtx0_x);
                                cy0 = vtx0_z + sp98 * (vtx1_z - vtx0_z);
                                cx1 = vtx2_x + sp9C * (vtx1_x - vtx2_x);
                                cy1 = vtx2_z + sp9C * (vtx1_z - vtx2_z);
                            } else {
                                cx0 = vtx0_x + sp98 * (vtx2_x - vtx0_x);
                                cy0 = vtx0_z + sp98 * (vtx2_z - vtx0_z);
                                cx1 = vtx1_x + sp9C * (vtx2_x - vtx1_x);
                                cy1 = vtx1_z + sp9C * (vtx2_z - vtx1_z);
                            }

                            cx0 += sp50.x;
                            cy0 += sp50.z;
                            cx1 += sp50.x;
                            cy1 += sp50.z;

                            f32 spC8, spCC, spD0;
                            bool sp107 = cM3d_Len2dSqPntAndSegLine(
                                pwi->GetCx(), pwi->GetCz(),
                                cx0, cy0,
                                cx1, cy1,
                                &spCC, &spD0,
                                &spC8
                            );

                            f32 spD4 = spCC - pwi->GetCx();
                            f32 spD8 = spD0 - pwi->GetCz();
                            f32 spDC = pwi->GetWallRR(cir_index);

                            if (!(spC8 > spDC) && !(spD4 * sp50.x + spD8 * sp50.z < 0.0f)) {
                                if (sp107 == 1) {
                                    positionWallCorrect(pwi, sp6C, tri->m_plane, pwi->GetPos(),
                                                        std::sqrtf(spC8));
                                    pwi->CalcMovePosWork();
                                    pwi->SetWallCirHit(cir_index);
                                    pwi->SetWallPolyIndex(cir_index, i_poly_idx);
                                    pwi->SetWallAngleY(
                                        cir_index,
                                        cM_atan2s(tri->m_plane.GetNP()->x, tri->m_plane.GetNP()->z)
                                    );
                                    correct = true;
                                } else {
                                    cx0 -= sp50.x;
                                    cy0 -= sp50.z;
                                    cx1 -= sp50.x;
                                    cy1 -= sp50.z;

                                    f32 spE0 = cM3d_Len2dSq(cx0, cy0, pwi->GetPos()->x, pwi->GetPos()->z);
                                    f32 spE4 = cM3d_Len2dSq(cx1, cy1, pwi->GetPos()->x, pwi->GetPos()->z);

                                    f32 onx = -tri->m_plane.GetNP()->x;
                                    f32 ony = -tri->m_plane.GetNP()->z;

                                    JUT_ASSERT(463, !(cM3d_IsZero(onx) && cM3d_IsZero(ony)));

                                    if (spE0 < spE4) {
                                        if (!(spE0 > spDC) && !(std::fabsf(spE0 - spDC) < 0.008f)) {
                                            f32 spF0, spF4;
                                            cM2d_CrossCirLin(*pwi->GetWallCirP(cir_index), cx0, cy0,
                                                             onx, ony, &spF0, &spF4);
                                            pwi->GetPos()->x += cx0 - spF0;
                                            pwi->GetPos()->z += cy0 - spF4;

                                            CHECK_FLOAT_CLASS(484, pwi->GetPos()->x);
                                            CHECK_FLOAT_CLASS(485, pwi->GetPos()->z);

                                            pwi->CalcMovePosWork();
                                            pwi->SetWallCirHit(cir_index);
                                            pwi->SetWallPolyIndex(cir_index, i_poly_idx);
                                            pwi->SetWallAngleY(
                                                cir_index,
                                                cM_atan2s(tri->m_plane.GetNP()->x, tri->m_plane.GetNP()->z)
                                            );
                                            correct = true;
                                            pwi->SetWallHit();
                                        }
                                    } else if (!(spE4 > spDC) && !(std::fabsf(spE4 - spDC) < 0.008f)) {
                                        f32 spF8, spFC;
                                        cM2d_CrossCirLin(*pwi->GetWallCirP(cir_index), cx1, cy1,
                                                         onx, ony, &spF8, &spFC);
                                        pwi->GetPos()->x += cx1 - spF8;
                                        pwi->GetPos()->z += cy1 - spFC;

                                        CHECK_FLOAT_CLASS(524, pwi->GetPos()->x);
                                        CHECK_FLOAT_CLASS(525, pwi->GetPos()->z);

                                        pwi->CalcMovePosWork();
                                        pwi->SetWallCirHit(cir_index);
                                        pwi->SetWallPolyIndex(cir_index, i_poly_idx);
                                        pwi->SetWallAngleY(
                                            cir_index,
                                            cM_atan2s(tri->m_plane.GetNP()->x, tri->m_plane.GetNP()->z)
                                        );
                                        correct = true;
                                        pwi->SetWallHit();
                                    }
                                }
                            }
                        }
                    }
                }

                cir_index++;
            }
        }

        if (rwg_elm->next == 0xFFFF) {
            break;
        }

        i_poly_idx = rwg_elm->next;
    }

    return correct;
}

/* 800A6DF8-800A7004       .text WallCorrectRp__4dBgWFP9dBgS_Acchi */
bool dBgW::WallCorrectRp(dBgS_Acch* acch, int i) {
    cBgW_NodeTree* node = &m_nt_tbl[i];
    if (!node->Cross(acch->GetWallBmdCylP()))
        return false;

    cBgD_Tree_t* tree = &pm_bgd->m_tree_tbl[i];
    bool ret = false;
    if (tree->mFlag & 1) {
        if (pm_blk[tree->mBlock].wall != 0xFFFF && RwgWallCorrect(acch, pm_blk[tree->mBlock].wall))
            ret = true;
        if (pm_blk[tree->mBlock].roof != 0xFFFF && RwgWallCorrect(acch, pm_blk[tree->mBlock].roof))
            ret = true;
        return ret;
    } else {
        if (tree->mChild[0] != 0xFFFF && WallCorrectRp(acch, tree->mChild[0]))
            ret = true;
        if (tree->mChild[1] != 0xFFFF && WallCorrectRp(acch, tree->mChild[1]))
            ret = true;
        if (tree->mChild[2] != 0xFFFF && WallCorrectRp(acch, tree->mChild[2]))
            ret = true;
        if (tree->mChild[3] != 0xFFFF && WallCorrectRp(acch, tree->mChild[3]))
            ret = true;
        if (tree->mChild[4] != 0xFFFF && WallCorrectRp(acch, tree->mChild[4]))
            ret = true;
        if (tree->mChild[5] != 0xFFFF && WallCorrectRp(acch, tree->mChild[5]))
            ret = true;
        if (tree->mChild[6] != 0xFFFF && WallCorrectRp(acch, tree->mChild[6]))
            ret = true;
        if (tree->mChild[7] != 0xFFFF && WallCorrectRp(acch, tree->mChild[7]))
            ret = true;
        return ret;
    }
}

/* 800A7004-800A7120       .text WallCorrectGrpRp__4dBgWFP9dBgS_Acchii */
bool dBgW::WallCorrectGrpRp(dBgS_Acch* acch, int grp_id, int depth) {
    if (ChkGrpThrough(grp_id, acch->GetGrpPassChk(), depth))
        return false;

    cBgW_GrpElm* grp = &pm_grp[grp_id];

    if (!grp->aab.Cross(acch->GetWallBmdCylP()))
        return false;

    bool ret = false;
    u32 tree_idx = pm_bgd->m_g_tbl[grp_id].m_tree_idx;
    if (tree_idx != 0xFFFF && WallCorrectRp(acch, tree_idx))
        ret = true;

    s32 child_idx = pm_bgd->m_g_tbl[grp_id].m_first_child;
    while (true) {
        if (child_idx == 0xFFFF)
            break;
        if (WallCorrectGrpRp(acch, child_idx, depth + 1))
            ret = true;
        child_idx = pm_bgd->m_g_tbl[child_idx].m_next_sibling;
    }

    return ret;
}

/* 800A7120-800A72E0       .text RwgRoofChk__4dBgWFUsP12dBgS_RoofChk */
bool dBgW::RwgRoofChk(u16 poly_index, dBgS_RoofChk* chk) {
    bool ret = false;
    while (true) {
        f32 y;
        if (pm_tri[poly_index].m_plane.getCrossY(*chk->GetPosP(), &y) && y > chk->GetPosP()->y && y < chk->GetNowY()) {
            cBgD_Tri_t* tri;
            tri = &pm_bgd->m_t_tbl[poly_index];
            if (cM3d_CrossY_Tri(pm_vtx_tbl[tri->vtx0], pm_vtx_tbl[tri->vtx1], pm_vtx_tbl[tri->vtx2], pm_tri[poly_index].m_plane, chk->GetPosP()) && !ChkPolyThrough(poly_index, chk->GetPolyPassChk())) {
                chk->SetNowY(y);
                chk->SetPolyIndex(poly_index);
                ret = true;
            }
        }

        if (pm_rwg[poly_index].next == 0xFFFF)
            break;

        poly_index = pm_rwg[poly_index].next;
    }

    return ret;
}

/* 800A72E0-800A7514       .text RoofChkRp__4dBgWFP12dBgS_RoofChki */
bool dBgW::RoofChkRp(dBgS_RoofChk* chk, int i) {
    cBgW_NodeTree* node = &m_nt_tbl[i];
    // if (!node->CrossY(chk->GetPosP()) || !node->UnderPlaneYUnder(chk->GetNowY()) || node->TopPlaneYUnder(chk->GetPosP()->y))
    if (!node->CrossY(chk->GetPosP()) || !(node->GetMinY() < chk->GetNowY()) || node->TopPlaneYUnder(chk->GetPosP()->y))
        return false;

    cBgD_Tree_t* tree = &pm_bgd->m_tree_tbl[i];
    if (tree->mFlag & 1) {
        if (pm_blk[tree->mBlock].roof != 0xFFFF && RwgRoofChk(pm_blk[tree->mBlock].roof, chk))
            return true;
        return false;
    } else {
        bool ret = false;
        if (tree->mChild[0] != 0xFFFF && RoofChkRp(chk, tree->mChild[0]))
            ret = true;
        if (tree->mChild[1] != 0xFFFF && RoofChkRp(chk, tree->mChild[1]))
            ret = true;
        if (tree->mChild[2] != 0xFFFF && RoofChkRp(chk, tree->mChild[2]))
            ret = true;
        if (tree->mChild[3] != 0xFFFF && RoofChkRp(chk, tree->mChild[3]))
            ret = true;
        if (tree->mChild[4] != 0xFFFF && RoofChkRp(chk, tree->mChild[4]))
            ret = true;
        if (tree->mChild[5] != 0xFFFF && RoofChkRp(chk, tree->mChild[5]))
            ret = true;
        if (tree->mChild[6] != 0xFFFF && RoofChkRp(chk, tree->mChild[6]))
            ret = true;
        if (tree->mChild[7] != 0xFFFF && RoofChkRp(chk, tree->mChild[7]))
            ret = true;
        return ret;
    }
}

/* 800A7514-800A767C       .text RoofChkGrpRp__4dBgWFP12dBgS_RoofChkii */
bool dBgW::RoofChkGrpRp(dBgS_RoofChk* chk, int grp_id, int depth) {
    if (ChkGrpThrough(grp_id, chk->GetGrpPassChk(), depth))
        return false;

    cBgW_GrpElm* grp = &pm_grp[grp_id];

    // if (!grp->aab.CrossY(chk->GetPosP()) || !grp->aab.UnderPlaneYUnder(chk->GetNowY()) || grp->aab.TopPlaneYUnder(chk->GetPosP()->y))
    if (!grp->aab.CrossY(chk->GetPosP()) || !(grp->aab.GetMinY() < chk->GetNowY()) || grp->aab.TopPlaneYUnder(chk->GetPosP()->y))
        return false;

    bool ret = false;
    cBgD_Grp_t* grpd = &pm_bgd->m_g_tbl[grp_id];
    u32 tree_idx = grpd->m_tree_idx;
    if (tree_idx != 0xFFFF && RoofChkRp(chk, tree_idx))
        ret = true;

    s32 child_idx = grpd->m_first_child;
    while (true) {
        if (child_idx == 0xFFFF)
            break;
        if (RoofChkGrpRp(chk, child_idx, depth + 1))
            ret = true;
        child_idx = pm_bgd->m_g_tbl[child_idx].m_next_sibling;
    }

    return ret;
}

/* 800A767C-800A783C       .text RwgSplGrpChk__4dBgWFUsP14dBgS_SplGrpChk */
bool dBgW::RwgSplGrpChk(u16 poly_index, dBgS_SplGrpChk* chk) {
    bool ret = false;
    while (true) {
        f32 y;
        if (pm_tri[poly_index].m_plane.getCrossY(*chk->GetPosP(), &y) && y < chk->GetRoof() && y > chk->GetHeight()) {
            cBgD_Tri_t* tri;
            tri = &pm_bgd->m_t_tbl[poly_index];
            if (cM3d_CrossY_Tri(pm_vtx_tbl[tri->vtx0], pm_vtx_tbl[tri->vtx1], pm_vtx_tbl[tri->vtx2], pm_tri[poly_index].m_plane, chk->GetPosP()) && !ChkPolyThrough(poly_index, chk->GetPolyPassChk())) {
                chk->SetHeight(y);
                chk->SetPolyIndex(poly_index);
                ret = true;
            }
        }

        if (pm_rwg[poly_index].next == 0xFFFF)
            break;

        poly_index = pm_rwg[poly_index].next;
    }

    return ret;
}

/* 800A783C-800A7A74       .text SplGrpChkRp__4dBgWFP14dBgS_SplGrpChki */
bool dBgW::SplGrpChkRp(dBgS_SplGrpChk* chk, int i) {
    cBgW_NodeTree* node = &m_nt_tbl[i];
    // if (!node->CrossY(chk->GetPosP()) || !node->UnderPlaneYUnder(chk->GetRoof()) || node->TopPlaneYUnder(chk->GetHeight()))
    if (!node->CrossY(chk->GetPosP()) || !(node->GetMinY() < chk->GetRoof()) || node->GetMaxY() < chk->GetHeight())
        return false;

    cBgD_Tree_t* tree = &pm_bgd->m_tree_tbl[i];
    if (tree->mFlag & 1) {
        if (pm_blk[tree->mBlock].ground != 0xFFFF && RwgSplGrpChk(pm_blk[tree->mBlock].ground, chk))
            return true;
        return false;
    } else {
        bool ret = false;
        if (tree->mChild[0] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[0]))
            ret = true;
        if (tree->mChild[1] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[1]))
            ret = true;
        if (tree->mChild[2] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[2]))
            ret = true;
        if (tree->mChild[3] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[3]))
            ret = true;
        if (tree->mChild[4] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[4]))
            ret = true;
        if (tree->mChild[5] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[5]))
            ret = true;
        if (tree->mChild[6] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[6]))
            ret = true;
        if (tree->mChild[7] != 0xFFFF && SplGrpChkRp(chk, tree->mChild[7]))
            ret = true;
        return ret;
    }
}

/* 800A7A74-800A7BDC       .text SplGrpChkGrpRp__4dBgWFP14dBgS_SplGrpChkii */
bool dBgW::SplGrpChkGrpRp(dBgS_SplGrpChk* chk, int grp_id, int depth) {
    if (ChkGrpThrough(grp_id, chk->GetGrpPassChk(), depth))
        return false;

    cBgW_GrpElm* grp = &pm_grp[grp_id];

    // if (!grp->aab.CrossY(chk->GetPosP()) || !grp->aab.UnderPlaneYUnder(chk->GetRoof()) || grp->aab.TopPlaneYUnder(chk->GetHeight()))
    if (!grp->aab.CrossY(chk->GetPosP()) || !(grp->aab.GetMinY() < chk->GetRoof()) || grp->aab.GetMaxY() < chk->GetHeight())
        return false;

    bool ret = false;
    cBgD_Grp_t* grpd = &pm_bgd->m_g_tbl[grp_id];
    u16 tree_idx = grpd->m_tree_idx;
    if (tree_idx != 0xFFFF && SplGrpChkRp(chk, tree_idx))
        ret = true;

    s32 child_idx = grpd->m_first_child;
    while (true) {
        if (child_idx == 0xFFFF)
            break;
        if (SplGrpChkGrpRp(chk, child_idx, depth + 1))
            ret = true;
        child_idx = pm_bgd->m_g_tbl[child_idx].m_next_sibling;
    }

    return ret;
}

/* 800A7BDC-800A7DCC       .text RwgSphChk__4dBgWFUsP11dBgS_SphChkPv */
bool dBgW::RwgSphChk(u16 i_poly_idx, dBgS_SphChk* i_sphchk, void* i_data) {
    cM3dGTri tri;
    cBgW_RwgElm* rwg;
    cBgD_Tri_t* tri_t;

    bool chk = false;
    while (true) {
        rwg = &pm_rwg[i_poly_idx];
        if (!ChkPolyThrough(i_poly_idx, i_sphchk->GetPolyPassChk())) {
            tri_t = &pm_bgd->m_t_tbl[i_poly_idx];
            tri.setBg(&pm_vtx_tbl[tri_t->vtx0], &pm_vtx_tbl[tri_t->vtx1],
                      &pm_vtx_tbl[tri_t->vtx2], &pm_tri[i_poly_idx].m_plane);

            if (i_sphchk->cross(&tri)) {
                if (i_sphchk->mpCallback != NULL) {
                    i_sphchk->mpCallback(i_sphchk, pm_vtx_tbl, tri_t->vtx0, tri_t->vtx1,
                                        tri_t->vtx2, &pm_tri[i_poly_idx].m_plane, i_data);
                }
                i_sphchk->SetPolyIndex(i_poly_idx);
                chk = true;
            }
        }

        if (rwg->next == 0xFFFF)
            break;
        i_poly_idx = rwg->next;
    }

    return chk;
}

/* 800A7DCC-800A8038       .text SphChkRp__4dBgWFP11dBgS_SphChkPvi */
bool dBgW::SphChkRp(dBgS_SphChk* chk, void* user, int i) {
    cBgW_NodeTree* node = &m_nt_tbl[i];
    if (!node->Cross(chk))
        return false;

    cBgD_Tree_t* tree = &pm_bgd->m_tree_tbl[i];
    bool ret = false;
    if (tree->mFlag & 1) {
        if (pm_blk[tree->mBlock].ground != 0xFFFF && RwgSphChk(pm_blk[tree->mBlock].ground, chk, user))
            ret = true;
        if (pm_blk[tree->mBlock].roof != 0xFFFF && RwgSphChk(pm_blk[tree->mBlock].roof, chk, user))
            ret = true;
        if (pm_blk[tree->mBlock].wall != 0xFFFF && RwgSphChk(pm_blk[tree->mBlock].wall, chk, user))
            ret = true;
        return ret;
    } else {
        if (tree->mChild[0] != 0xFFFF && SphChkRp(chk, user, tree->mChild[0]))
            ret = true;
        if (tree->mChild[1] != 0xFFFF && SphChkRp(chk, user, tree->mChild[1]))
            ret = true;
        if (tree->mChild[2] != 0xFFFF && SphChkRp(chk, user, tree->mChild[2]))
            ret = true;
        if (tree->mChild[3] != 0xFFFF && SphChkRp(chk, user, tree->mChild[3]))
            ret = true;
        if (tree->mChild[4] != 0xFFFF && SphChkRp(chk, user, tree->mChild[4]))
            ret = true;
        if (tree->mChild[5] != 0xFFFF && SphChkRp(chk, user, tree->mChild[5]))
            ret = true;
        if (tree->mChild[6] != 0xFFFF && SphChkRp(chk, user, tree->mChild[6]))
            ret = true;
        if (tree->mChild[7] != 0xFFFF && SphChkRp(chk, user, tree->mChild[7]))
            ret = true;
        return ret;
    }
}

/* 800A8038-800A8158       .text SphChkGrpRp__4dBgWFP11dBgS_SphChkPvii */
bool dBgW::SphChkGrpRp(dBgS_SphChk* chk, void* user, int grp_id, int depth) {
    if (ChkGrpThrough(grp_id, chk->GetGrpPassChk(), depth))
        return false;

    cBgW_GrpElm* grp = &pm_grp[grp_id];

    if (!grp->aab.Cross(chk))
        return false;

    bool ret = false;
    cBgD_Grp_t* grpd = &pm_bgd->m_g_tbl[grp_id];
    u16 tree_idx = grpd->m_tree_idx;
    if (tree_idx != 0xFFFF && SphChkRp(chk, user, tree_idx))
        ret = true;

    s32 child_idx = grpd->m_first_child;
    while (true) {
        if (child_idx == 0xFFFF)
            break;
        if (SphChkGrpRp(chk, user, child_idx, depth + 1))
            ret = true;
        child_idx = pm_bgd->m_g_tbl[child_idx].m_next_sibling;
    }

    return ret;
}

/* 800A8158-800A819C       .text positionWallCrrPos__4dBgWFR8cM3dGTriP11dBgS_CrrPosP4cXyzff */
void dBgW::positionWallCrrPos(cM3dGTri& plane, dBgS_CrrPos* crr, cXyz* pos, f32 dist, f32 rad) {
    crr->SetWallHit();
    f32 move = (crr->GetWallR() - rad) * dist;
    pos->x += move * plane.mNormal.x;
    pos->z += move * plane.mNormal.z;
}

/* 800A819C-800A8964       .text RwgWallCrrPos__4dBgWFUsP11dBgS_CrrPos */
bool dBgW::RwgWallCrrPos(u16 i_poly_index, dBgS_CrrPos* crr) {
    cBgW_RwgElm* rwg_elm;
    cBgD_Tri_t* tri_t;
    cM3dGPla* plane;
    bool ret = false;
    cM3dGTri tri;
    cXyz wall_top_pos = *crr->GetPos();
    wall_top_pos.y += crr->GetWallH();
    cXyz old_wall_top_pos = *crr->GetOldPos();
    old_wall_top_pos.y += crr->GetWallH();
    u32 poly_index_z = i_poly_index;
    u32 poly_index_x = i_poly_index;

    // Z
    while (true) {
        rwg_elm = &pm_rwg[poly_index_z];
        if (!ChkPolyThrough(poly_index_z, crr->GetPolyPassChk())) {
            tri_t = &pm_bgd->m_t_tbl[poly_index_z];
            plane = &pm_tri[poly_index_z].m_plane;
            tri.setBg(
                &pm_vtx_tbl[tri_t->vtx0],
                &pm_vtx_tbl[tri_t->vtx1],
                &pm_vtx_tbl[tri_t->vtx2],
                plane
            );
            
            f32 dist = tri.getSignedLenPos(&wall_top_pos);
            if (std::fabsf(dist) > crr->GetWallR()) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_z = rwg_elm->next;
                continue;
            }
            
            f32 nx = plane->GetNP()->x;
            f32 nz = plane->GetNP()->z;
            f32 f4 = std::sqrtf(nx*nx + nz*nz);
            if (cM3d_IsZero(f4)) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_z = rwg_elm->next;
                continue;
            }
            
            f32 f29 = 1.0f / f4;
            f32 f28 = f29 * std::fabsf(nz);
            if (f28 < 0.4f) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_z = rwg_elm->next;
                continue;
            }
            
            // Is this an inline? 
            f32 min_z = tri.mA.z;
            f32 max_z = min_z;
            if (min_z > tri.mB.z) {
                min_z = tri.mB.z;
            } else if (max_z < tri.mB.z) {
                max_z = tri.mB.z;
            }
            if (min_z > tri.mC.z) {
                min_z = tri.mC.z;
            } else if (max_z < tri.mC.z) {
                max_z = tri.mC.z;
            }
            min_z -= crr->GetWallR();
            max_z += crr->GetWallR();
            if (min_z > wall_top_pos.z || max_z < wall_top_pos.z) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_z = rwg_elm->next;
                continue;
            }
            
            f32 cross_len;
            if (tri.crossZ(&wall_top_pos, &cross_len)) {
                f32 f2 = crr->GetWallR() / f28;
                f32 f1 = cross_len - wall_top_pos.z;
                f1 *= nz;
                if (std::fabsf(cross_len - wall_top_pos.z) <= f2 && f1 <= 4.0f) {
                    positionWallCrrPos(tri, crr, &crr->GetPosVec(), f29, dist);
                    crr->SetWallPolyIndex(poly_index_z);
                    ret = true;
                    crr->SetZCrr();
                }
            }
        }

        if (rwg_elm->next == 0xFFFF)
            break;
        poly_index_z = rwg_elm->next;
    }

    // X
    while (true) {
        rwg_elm = &pm_rwg[poly_index_x];
        if (!ChkPolyThrough(poly_index_x, crr->GetPolyPassChk())) {
            tri_t = &pm_bgd->m_t_tbl[poly_index_x];
            plane = &pm_tri[poly_index_x].m_plane;
            tri.setBg(
                &pm_vtx_tbl[tri_t->vtx0],
                &pm_vtx_tbl[tri_t->vtx1],
                &pm_vtx_tbl[tri_t->vtx2],
                plane
            );
            
            f32 dist = tri.getSignedLenPos(&wall_top_pos);
            if (std::fabsf(dist) > crr->GetWallR()) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_x = rwg_elm->next;
                continue;
            }
            
            f32 nx = plane->GetNP()->x;
            f32 nz = plane->GetNP()->z;
            f32 f4 = std::sqrtf(nx*nx + nz*nz);
            if (cM3d_IsZero(f4)) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_x = rwg_elm->next;
                continue;
            }
            
            f32 f28 = 1.0f / f4;
            f32 f29 = f28 * std::fabsf(nx);
            if (f29 < 0.4f) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_x = rwg_elm->next;
                continue;
            }
            
            // Is this an inline? 
            f32 min_x = tri.mA.x;
            f32 max_x = min_x;
            if (min_x > tri.mB.x) {
                min_x = tri.mB.x;
            } else if (max_x < tri.mB.x) {
                max_x = tri.mB.x;
            }
            if (min_x > tri.mC.x) {
                min_x = tri.mC.x;
            } else if (max_x < tri.mC.x) {
                max_x = tri.mC.x;
            }
            min_x -= crr->GetWallR();
            max_x += crr->GetWallR();
            if (min_x > wall_top_pos.x || max_x < wall_top_pos.x) {
                if (rwg_elm->next == 0xFFFF) {
                    break;
                }
                poly_index_x = rwg_elm->next;
                continue;
            }
            
            f32 cross_len;
            if (tri.crossX(&wall_top_pos, &cross_len)) {
                f32 f2 = crr->GetWallR() / f29;
                f32 f1 = cross_len - wall_top_pos.x;
                f1 *= nx;
                if (std::fabsf(cross_len - wall_top_pos.x) <= f2 && f1 <= 4.0f) {
                    positionWallCrrPos(tri, crr, &crr->GetPosVec(), f28, dist);
                    crr->SetWallPolyIndex(poly_index_x);
                    ret = true;
                    crr->SetXCrr();
                }
            }
        }

        poly_index_x = rwg_elm->next;
        if (poly_index_x == 0xFFFF) {
            break;
        }
        poly_index_x = rwg_elm->next;
    }

    if (ret) {
        crr->SetCyl();
        crr->SetLin();
    }

    return ret;
}

void dBgW::dummyfunc() {
    // TODO: find where this assert actually comes from
    // cBgW::RwgShdwDraw ?
    int index = 0;
    JUT_ASSERT(0, 0 <= index && index < pm_bgd->m_t_num);
}

/* 800A8964-800A8B70       .text WallCrrPosRp__4dBgWFP11dBgS_CrrPosi */
bool dBgW::WallCrrPosRp(dBgS_CrrPos* crr, int i) {
    cBgW_NodeTree* node = &m_nt_tbl[i];
    if (!node->Cross(crr->GetCylP()))
        return false;

    bool ret = false;
    cBgD_Tree_t* tree = &pm_bgd->m_tree_tbl[i];
    if (tree->mFlag & 1) {
        if (pm_blk[tree->mBlock].wall != 0xFFFF && RwgWallCrrPos(pm_blk[tree->mBlock].wall, crr))
            ret = true;
        if (pm_blk[tree->mBlock].roof != 0xFFFF && RwgWallCrrPos(pm_blk[tree->mBlock].roof, crr))
            ret = true;
        return ret;
    } else {
        if (tree->mChild[0] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[0]))
            ret = true;
        if (tree->mChild[1] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[1]))
            ret = true;
        if (tree->mChild[2] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[2]))
            ret = true;
        if (tree->mChild[3] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[3]))
            ret = true;
        if (tree->mChild[4] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[4]))
            ret = true;
        if (tree->mChild[5] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[5]))
            ret = true;
        if (tree->mChild[6] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[6]))
            ret = true;
        if (tree->mChild[7] != 0xFFFF && WallCrrPosRp(crr, tree->mChild[7]))
            ret = true;
        return ret;
    }
}

/* 800A8B70-800A8C8C       .text WallCrrPosGrpRp__4dBgWFP11dBgS_CrrPosii */
bool dBgW::WallCrrPosGrpRp(dBgS_CrrPos* crr, int grp_id, int depth) {
    if (ChkGrpThrough(grp_id, crr->GetGrpPassChk(), depth))
        return false;

    cBgW_GrpElm* grp = &pm_grp[grp_id];

    if (!grp->aab.Cross(crr->GetCylP()))
        return false;

    bool ret = false;
    u32 tree_idx = pm_bgd->m_g_tbl[grp_id].m_tree_idx;
    if (tree_idx != 0xFFFF && WallCrrPosRp(crr, tree_idx))
        ret = true;

    s32 child_idx = pm_bgd->m_g_tbl[grp_id].m_first_child;
    while (true) {
        if (child_idx == 0xFFFF)
            break;
        if (WallCrrPosGrpRp(crr, child_idx, depth + 1))
            ret = true;
        child_idx = pm_bgd->m_g_tbl[child_idx].m_next_sibling;
    }

    return ret;
}

/* 800A8C8C-800A8CB4       .text WallCrrPos__4dBgWFP11dBgS_CrrPos */
bool dBgW::WallCrrPos(dBgS_CrrPos* crr) {
    return WallCrrPosGrpRp(crr, m_rootGrpIdx, 1);
}

/* 800A8CB4-800A8CF0       .text CrrPos__4dBgWFR13cBgS_PolyInfoPvbP4cXyzP5csXyzP5csXyz */
void dBgW::CrrPos(cBgS_PolyInfo& poly, void* user, bool accept, cXyz* pos, csXyz* angle, csXyz* shape_angle) {
    if (m_crr_func != NULL)
        m_crr_func(this, user, poly, accept, pos, angle, shape_angle);
}

/* 800A8CF0-800A8D2C       .text TransPos__4dBgWFR13cBgS_PolyInfoPvbP4cXyzP5csXyzP5csXyz */
void dBgW::TransPos(cBgS_PolyInfo& poly, void* user, bool accept, cXyz* pos, csXyz* angle, csXyz* shape_angle) {
    if (m_crr_func != NULL)
        m_crr_func(this, user, poly, accept, pos, angle, shape_angle);
}

/* 800A8D2C-800A9474       .text ChkPolyThrough__4dBgWFiP16cBgS_PolyPassChk */
bool dBgW::ChkPolyThrough(int poly_index, cBgS_PolyPassChk* chk) {
    if (chk == NULL)
        return false;
    if (chk->mbObjThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x02)
        return true;
    if (chk->mbCamThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x01)
        return true;
    if (chk->mbLinkThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x04)
        return true;
    if (chk->mbArrowThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x08)
        return true;
    if (chk->mbBombThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x20)
        return true;
    if (chk->mbBoomerangThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x40)
        return true;
    if (chk->mbRopeThrough && GetPolyInf3(GetPolyInfId(poly_index)) & 0x80)
        return true;
    return false;
}

/* 800A9474-800A9684       .text ChkShdwDrawThrough__4dBgWFiP16cBgS_PolyPassChk */
bool dBgW::ChkShdwDrawThrough(int poly_index, cBgS_PolyPassChk* chk) {
    if ((GetPolyInf0(GetPolyInfId(poly_index)) >> 27) & 1)
        return true;

    if (GetPolyInf3(GetPolyInfId(poly_index)) & 0x08)
        return true;

    return false;
}

/* 800A9684-800A974C       .text ChkGrpThrough__4dBgWFiP15cBgS_GrpPassChki */
bool dBgW::ChkGrpThrough(int grp_id, cBgS_GrpPassChk* _chk, int depth) {
    dBgS_GrpPassChk* chk = (dBgS_GrpPassChk*)_chk;
    if (depth != 2 || chk == NULL)
        return false;

    int info = pm_bgd->m_g_tbl[grp_id].m_info;
    if (!(info & 0x80700) && chk->MaskNormalGrp())
        return false;
    if ((info & 0x00100) && chk->MaskWaterGrp())
        return false;
    if ((info & 0x00200) && chk->MaskYoganGrp())
        return false;
    if ((info & 0x00400) && chk->MaskDokuGrp())
        return false;
    if ((info & 0x80000) && chk->MaskLightGrp())
        return false;
    return true;
}

/* 800A974C-800A97E4       .text ChangeAttributeCodeByPathPntNo__4dBgWFiUl */
void dBgW::ChangeAttributeCodeByPathPntNo(int pnt_no, u32 attr) {
    if (pm_bgd != NULL) {
        for (s32 i = 0; i < pm_bgd->m_ti_num; i++) {
            u32 ti_pnt_no = dBgS_GetRoomPathPntNo(pm_bgd->m_ti_tbl[i].mPolyInf2);
            if (ti_pnt_no == pnt_no)
                dBgS_ChangeAttributeCode(attr, &pm_bgd->m_ti_tbl[i].mPolyInf1);
        }
    }
}

/* 800A97E4-800A986C       .text dBgW_NewSet__FP6cBgD_tUlPA3_A4_f */
dBgW* dBgW_NewSet(cBgD_t* bgd, u32 flag, Mtx* mtx) {
    dBgW* rt = new dBgW();
    if (rt == NULL)
        return NULL;
    if (rt->Set(bgd, flag, mtx))
        return NULL;
    return rt;
}