rodecomp/Source/Contents/Models/ModelQuaternion.cpp
ragnarok-clanker e168b4e4a6 Restore translation-unit ownership and publish verified source corrections
Owner-authorized source migration: 31 helper-only translation units were merged into their callers or existing inline headers; both build manifests updated. Includes the preserved source payload, Lua configuration matching wowdecomp, and exact malloca expansion without diagnostic pragmas.

449 native units compiled locally and 449 staged units compiled by the pinned server toolchain. No previously byte-matched function regressed. Compiler mapping diagnostics remain recorded as needs_cleanup, not accepted or peer-confirmed. Existing independent review records are preserved. README.md is intentionally unchanged.
2026-10-25 15:42:21 +00:00

69 lines
2.5 KiB
C++

#include "Contents/Models/ModelAnimation.h"
#include <bit>
#include <cmath>
// OFFSET: 0x00554CD0
// OFFSET: 0x00554B90
// FUNCTION: fn_02030
// FUNCTION: fn_02029
void QuaternionMatrix(const ModelRotationKey& key, AffineMatrix& output) {
const float x = key.rotation[0];
const float y = key.rotation[1];
const float z = key.rotation[2];
const float w = key.rotation[3];
const float xx = x * (x + x);
const float wx = w * (x + x);
const float xy = x * (y + y);
const float xz = x * (z + z);
const float yy = y * (y + y);
const float yz = y * (z + z);
const float wy = w * (y + y);
const float zz = z * (z + z);
const float wz = w * (z + z);
output.values[9] = output.values[10] = output.values[11] = 0.0f;
output.values[0] = 1.0f - (zz + yy);
output.values[1] = xy + wz;
output.values[3] = xy - wz;
output.values[2] = xz - wy;
output.values[4] = 1.0f - (zz + xx);
output.values[8] = 1.0f - (yy + xx);
output.values[5] = yz + wx;
output.values[7] = yz - wx;
output.values[6] = xz + wy;
}
// OFFSET: 0x00541B30
// FUNCTION: fn_01736
void InterpolateModelRotation(float amount, const ModelRotationKey& first, const ModelRotationKey& second, int spins, ModelRotationKey& output) {
const float dot = ((second.rotation[1] * first.rotation[1] + second.rotation[0] * first.rotation[0]) + first.rotation[2] * second.rotation[2]) +
first.rotation[3] * second.rotation[3];
const bool flip = dot < 0.0f;
const float magnitude = flip ? -dot : dot;
constexpr double epsilon = 0.000001;
float firstWeight;
float secondWeight;
if (!(epsilon > 1.0 - static_cast<double>(magnitude))) {
const float angle = static_cast<float>(std::acos(static_cast<double>(magnitude)));
const float denominator = ClientSin(angle);
const float phase = (static_cast<float>(spins) * 3.141592f + angle) * amount;
firstWeight = ClientSin(angle - phase) / denominator;
secondWeight = ClientSin(phase) / denominator;
} else {
firstWeight = static_cast<float>(1.0 - static_cast<double>(amount));
secondWeight = amount;
}
if (flip) {
secondWeight = -secondWeight;
}
output.rotation[0] = first.rotation[0] * firstWeight + second.rotation[0] * secondWeight;
output.rotation[1] = secondWeight * second.rotation[1] + firstWeight * first.rotation[1];
output.rotation[2] = firstWeight * first.rotation[2] + secondWeight * second.rotation[2];
output.rotation[3] = firstWeight * first.rotation[3] + secondWeight * second.rotation[3];
}