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
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
|
#include "nw4r/g3d.h" // IWYU pragma: export
namespace nw4r {
namespace g3d {
namespace detail {
namespace dcc {
bool CalcTexMtx_Basic(math::MTX34 *pMtx, bool set, const TexSrt &rSrt, TexSrt::Flag flag) {
// Extract S/R/T flags
u32 index = flag >> 1 & 0b111;
// Scale-one, no rotate/trans
if (index == 0b111) {
return false;
}
f32 sinR, cosR;
math::SinCosDeg(&sinR, &cosR, rSrt.R);
if (set) {
// clang-format off
pMtx->m[0][0] = rSrt.Su * cosR; pMtx->m[0][1] = -rSrt.Sv * sinR; pMtx->m[0][2] = 0.0f; pMtx->m[0][3] = rSrt.Tu;
pMtx->m[1][0] = rSrt.Su * sinR; pMtx->m[1][1] = rSrt.Sv * cosR; pMtx->m[1][2] = 0.0f; pMtx->m[1][3] = rSrt.Tv;
pMtx->m[2][0] = 0.0f; pMtx->m[2][1] = 0.0f; pMtx->m[2][2] = 1.0f; pMtx->m[2][3] = 0.0f;
// clang-format on
} else {
// clang-format off
math::MTX34 m;
m[0][0] = rSrt.Su * cosR; m[0][1] = -rSrt.Sv * sinR; m[0][2] = 0.0f; m[0][3] = rSrt.Tu;
m[1][0] = rSrt.Su * sinR; m[1][1] = rSrt.Sv * cosR; m[1][2] = 0.0f; m[1][3] = rSrt.Tv;
m[2][0] = 0.0f; m[2][1] = 0.0f; m[2][2] = 1.0f; m[2][3] = 0.0f;
// clang-format on
math::MTX34Mult(pMtx, &m, pMtx);
}
return true;
}
u32 CalcWorldMtx_Basic(
math::MTX34 *pW, math::VEC3 *pS, const math::MTX34 *pW1, const math::VEC3 *pS1, u32 attr,
const ChrAnmResult *pResult
) {
u32 flag = pResult->flags;
u32 newAttr = attr;
if ((flag & ChrAnmResult::FLAG_MTX_IDENT) || (flag & ChrAnmResult::FLAG_ROT_TRANS_ZERO)) {
if (detail::WorldMtxAttr::IsScaleOne(attr)) {
math::MTX34Copy(pW, pW1);
} else {
math::MTX34Scale(pW, pW1, pS1);
}
} else if (flag & ChrAnmResult::FLAG_ROT_ZERO) {
if (detail::WorldMtxAttr::IsScaleOne(attr)) {
math::VEC3 trans(pResult->rt._03, pResult->rt._13, pResult->rt._23);
math::MTX34Trans(pW, pW1, &trans);
} else {
math::MTX34 temp;
math::MTX34Scale(&temp, pS1, &pResult->rt);
math::MTX34Mult(pW, pW1, &temp);
}
} else if (detail::WorldMtxAttr::IsScaleOne(attr)) {
math::MTX34Mult(pW, pW1, &pResult->rt);
} else {
math::MTX34Scale(pW, pW1, pS1);
math::MTX34Mult(pW, pW, &pResult->rt);
}
if (flag & ChrAnmResult::FLAG_SCALE_ONE) {
newAttr = detail::WorldMtxAttr::AnmScaleOne(newAttr);
pS->x = pS->y = pS->z = 1.0f;
} else {
newAttr = detail::WorldMtxAttr::AnmNotScaleOne(newAttr);
*pS = pResult->s;
}
if (flag & ChrAnmResult::FLAG_SCALE_UNIFORM) {
newAttr = detail::WorldMtxAttr::AnmScaleUniform(newAttr);
} else {
newAttr = detail::WorldMtxAttr::AnmNotScaleUniform(newAttr);
}
return newAttr;
}
} // namespace dcc
} // namespace detail
} // namespace g3d
} // namespace nw4r
|