libs/SSystem/SComponent/c_m2d.cpp


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52

/**
 * c_m2d.cpp
 *
 */

#include "SSystem/SComponent/c_m2d.h"
#include "SSystem/SComponent/c_m3d.h"
#include "SSystem/SComponent/c_m3d_g_cir.h"

/* 80268260-80268560 262BA0 0300+00 0/0 4/4 0/0 .text cM2d_CrossCirLin__FR8cM2dGCirffffPfPf */
void cM2d_CrossCirLin(cM2dGCir& param_0, f32 param_1, f32 param_2, f32 param_3, f32 param_4,
                      f32* param_5, f32* param_6) {
    f32 fVar1 = param_1 - param_0.GetCx();
    f32 fVar15 = param_2 - param_0.GetCy();
    f32 dVar13 = param_3 * param_3 + param_4 * param_4;
    f32 dVar14 = 2.0f * ((param_3 * fVar1) + (param_4 * fVar15));
    f32 fVar3 = (fVar1 * fVar1 + fVar15 * fVar15) - (param_0.GetR() * param_0.GetR());
    f32 in_f31;

    if (cM3d_IsZero(dVar13)) {
        if (!cM3d_IsZero(dVar14)) {
            in_f31 = -fVar3 / dVar14;
        }
    } else {
        f32 dVar10 = ((dVar14 * dVar14) - (4.0f * dVar13) * fVar3);
        if (cM3d_IsZero(dVar10)) {
            in_f31 = (-dVar14 / (2.0f * dVar13));
        } else {
            if (dVar10 < 0.0f) {
            } else {
                f32 fVar2 = 1.0f / (2.0f * dVar13);
                f32 fVar15 = sqrtf(dVar10);
                fVar15 = fVar2 * (-dVar14 + fVar15);
                f32 fVar16 = sqrtf(dVar10);
                f32 fVar4 = fVar2 * (-dVar14 - fVar16);
                if (fVar15 > fVar4) {
                    in_f31 = fVar15;
                } else {
                    in_f31 = fVar4;
                }
            }
        }
    }

    if (cM3d_IsZero(in_f31)) {
        *param_5 = param_1;
        *param_6 = param_2;
    } else {
        *param_5 = param_1 + (in_f31 * param_3);
        *param_6 = param_2 + (in_f31 * param_4);
    }
}