mirror of
https://github.com/TwilitRealm/dusklight
synced 2026-07-11 13:08:33 -04:00
TakaRikka
a6e76c0841
* some wii OS fixes * remove old dol2asm comments * remove dol2asm.h * remove function address comments * normalize ATTRIBUTE_ALIGN usage * DECL_WEAK macro * fix gcc attribute weak macro * wrap more mwcc specific things in ifdefs * fixes * fix revo sdk version flags * fixes
83 lines
2.2 KiB
C++
83 lines
2.2 KiB
C++
/**
|
|
* c_m2d.cpp
|
|
*
|
|
*/
|
|
|
|
#include "SSystem/SComponent/c_m2d.h"
|
|
#include "SSystem/SComponent/c_m3d.h"
|
|
#include "SSystem/SComponent/c_m3d_g_cir.h"
|
|
#include "JSystem/JUtility/JUTAssert.h"
|
|
|
|
void cM2d_CrossCirLin(cM2dGCir& param_0, f32 param_1, f32 param_2, f32 param_3, f32 param_4,
|
|
f32* param_5, f32* param_6) {
|
|
int ans = 0;
|
|
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 c = (fVar1 * fVar1 + fVar15 * fVar15) - (param_0.GetR() * param_0.GetR());
|
|
JUT_ASSERT(71, c < 0.0f);
|
|
|
|
f32 t;
|
|
|
|
if (cM3d_IsZero(dVar13)) {
|
|
if (cM3d_IsZero(dVar14)) {
|
|
ans = 0;
|
|
} else {
|
|
ans = 1;
|
|
t = -c / dVar14;
|
|
}
|
|
} else {
|
|
f32 dVar10 = ((dVar14 * dVar14) - (4.0f * dVar13) * c);
|
|
if (cM3d_IsZero(dVar10)) {
|
|
ans = 1;
|
|
t = (-dVar14 / (2.0f * dVar13));
|
|
} else {
|
|
if (dVar10 < 0.0f) {
|
|
ans = 0;
|
|
} else {
|
|
ans = 2;
|
|
|
|
f32 fVar2 = 1.0f / (2.0f * dVar13);
|
|
f32 fVar15 = fVar2 * (-dVar14 + sqrtf(dVar10));
|
|
f32 fVar4 = fVar2 * (-dVar14 - sqrtf(dVar10));
|
|
if (fVar15 > fVar4) {
|
|
t = fVar15;
|
|
} else {
|
|
t = fVar4;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (cM3d_IsZero(t)) {
|
|
*param_5 = param_1;
|
|
*param_6 = param_2;
|
|
} else {
|
|
if (ans == 0 || t < 0.0f) {
|
|
OS_REPORT("\x1b[41;37m");
|
|
|
|
if (ans == 0) {
|
|
OS_REPORT("ans == 0\n");
|
|
}
|
|
|
|
if (t < 0.0f) {
|
|
OS_REPORT("t %f < 0.0f\n", t);
|
|
}
|
|
|
|
OS_REPORT("c.x %f c.y %f\n", param_0.GetCx(), param_0.GetCy());
|
|
OS_REPORT("r %f\n", param_0.GetR());
|
|
OS_REPORT("px %f py %f\n", param_1, param_2);
|
|
OS_REPORT("vx %f vy %f\n", param_3, param_4);
|
|
OS_REPORT("\x1b[m");
|
|
}
|
|
|
|
JUT_ASSERT(135, ans != 0);
|
|
JUT_ASSERT(137, t >= 0.0f);
|
|
|
|
*param_5 = param_1 + (t * param_3);
|
|
*param_6 = param_2 + (t * param_4);
|
|
}
|
|
}
|