ksys/phys: rearrange the folder layout to match link order

A folder's files are linked before its subfolders, and the rigid body
files are linked as one flat sequence. ListShape is the one file that
does not fit this order.

| Old | New |
|---|---|
| RigidBody/Shape/<Kind>/phys<Kind>Shape.cpp | RigidBody/Shape/phys<Kind>Shape.cpp |
| RigidBody/Shape/<Kind>/phys<Kind>RigidBody.cpp | RigidBody/physRigidBody<Kind>.cpp |
| RigidBody/Shape/List/physListShapeRigidBody.cpp | RigidBody/physRigidBodyListShape.cpp |
| physHavokMemoryAllocator.cpp | System/physHavokMemoryAllocator.cpp |
| StaticCompound/physStaticCompound{,Mgr,RigidBodyGroup,Util}.cpp | System/ |
| StaticCompound/physStaticCompound{Info,Autogen}.cpp | System/physStaticCompoundInfo.cpp |

The original has the type infos' cleanup functions just before
StaticCompoundInfo's functions, so the merged file defines the
reflection data first, with plain static cleanup functions as in
Havok's generated reflection code. Template instantiations would be
emitted after the rest of the file.

(AI assisted using Claude Fable 5.1 and Claude Opus 5.5)

1 files changed, 233 insertions, 0 deletions

diff --git a/src/KingSystem/Physics/System/physStaticCompound.cpp b/src/KingSystem/Physics/System/physStaticCompound.cpp
new file mode 100644
index 00000000..d95f642d
--- /dev/null
+++ b/src/KingSystem/Physics/System/physStaticCompound.cpp
@@ -0,0 +1,233 @@
+#include "KingSystem/Physics/System/physStaticCompound.h"
+#include <Havok/Common/Serialize/Util/hkNativePackfileUtils.h>
+#include <Havok/Common/Serialize/Util/hkRootLevelContainer.h>
+#include <Havok/Physics2012/Utilities/Serialize/hkpPhysicsData.h>
+#include <heap/seadHeapMgr.h>
+#include <prim/seadScopedLock.h>
+#include "KingSystem/Physics/System/physStaticCompoundInfo.h"
+#include "KingSystem/Physics/System/physStaticCompoundMgr.h"
+#include "KingSystem/Physics/System/physStaticCompoundRigidBodyGroup.h"
+#include "KingSystem/Physics/System/physSystem.h"
+#include "KingSystem/Utils/Debug.h"
+#include "KingSystem/Utils/HeapUtil.h"
+#include "KingSystem/Utils/SafeDelete.h"
+
+namespace ksys::phys {
+
+// + 1 because body groups are one indexed, with the 0th group acting as a dummy group
+constexpr int NumBodyGroups = 16 + 1;
+
+StaticCompound::StaticCompound() = default;
+
+StaticCompound::~StaticCompound() {
+    System::instance()->getStaticCompoundMgr()->removeStaticCompound(this);
+    mFlags.reset(Flag::Initialised);
+
+    {
+        sead::ScopedCurrentHeapSetter heap_setter{mHeap};
+        mFieldBodyGroups.freeBuffer();
+        mMapObjects.freeBuffer();
+    }
+
+    if (mContainerBuffer) {
+        hkNativePackfileUtils::unloadInPlace(mContainerBuffer, mContainerBufferSize);
+        mContainerBuffer = nullptr;
+        mContainerBufferSize = 0;
+    }
+
+    if (mBuffer) {
+        hkNativePackfileUtils::unloadInPlace(mBuffer, mBufferSize);
+        mBuffer = nullptr;
+        mBufferSize = 0;
+        mStaticCompoundInfo = nullptr;
+    }
+
+    util::safeDeleteHeap(mHeap);
+}
+
+void StaticCompound::doCreate_(u8* buffer, u32 buffer_size, sead::Heap* parent_heap) {
+    const char* error = nullptr;
+    mBuffer = buffer;
+    auto result = hkNativePackfileUtils::validatePackfileHeader(mBuffer, &error);
+    if (!result.isSuccess())
+        util::PrintDebugFmt("%s: invalid packfile: %s", __func__, error);
+    mBufferSize = hkNativePackfileUtils::getRequiredBufferSize(mBuffer, int(buffer_size));
+    mStaticCompoundInfo = static_cast<const StaticCompoundInfo*>(
+        hkNativePackfileUtils::loadInPlace(mBuffer, mBufferSize, nullptr, &error));
+
+    mContainerBuffer = buffer + mStaticCompoundInfo->m_Offset;
+    auto result2 = hkNativePackfileUtils::validatePackfileHeader(mContainerBuffer, &error);
+    if (!result2.isSuccess())
+        util::PrintDebugFmt("%s: invalid physics packfile: %s", __func__, error);
+    mContainerBufferSize =
+        hkNativePackfileUtils::getRequiredBufferSize(mContainerBuffer, int(buffer_size));
+    auto* container = static_cast<hkRootLevelContainer*>(
+        hkNativePackfileUtils::loadInPlace(mContainerBuffer, mContainerBufferSize));
+
+    auto* physics_data = container->findObject<hkpPhysicsData>();
+
+    mHeap = util::tryCreateDualHeap(parent_heap);
+    if (!mHeap) {
+        util::PrintDebugFmt("%s: failed to create dual heap", __func__);
+        return;
+    }
+    mHeap->enableWarning(false);
+    auto* heap = mHeap;
+
+    const auto& systems = physics_data->getPhysicsSystems();
+    mFieldBodyGroups.allocBufferAssert(NumBodyGroups, heap);
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].init(*systems[i], &mMtx, this, heap);
+
+    mName = systems[0]->getName();
+    mName.trimMatchedString("_0");
+
+    if (mStaticCompoundInfo->m_ActorInfo.getSize() > 0)
+        mMapObjects.allocBufferAssert(mStaticCompoundInfo->m_ActorInfo.getSize(), heap);
+
+    mFlags.set(Flag::Initialised);
+    mHeap->adjust();
+}
+
+bool StaticCompound::finishParsing_() {
+    mFlags.set(Flag::Initialised);
+    mMapObjects.fill(nullptr);
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].enableAllInstancesAndShapeKeys();
+
+    System::instance()->getStaticCompoundMgr()->addStaticCompound(this);
+    return true;
+}
+
+bool StaticCompound::m7_() {
+    if (isAnyRigidBodyAddedToWorld() || isAnyRigidBodyAddedOrBeingAddedToWorld()) {
+        removeFromWorld();
+        // We cannot unload this resource immediately.
+        return false;
+    }
+
+    System::instance()->getStaticCompoundMgr()->removeStaticCompound(this);
+    mFlags.reset(Flag::Initialised);
+    return true;
+}
+
+bool StaticCompound::isAnyRigidBodyAddedToWorld() const {
+    auto lock = sead::makeScopedLock(mCS);
+
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i) {
+        if (mFieldBodyGroups[i].isAnyRigidBodyAddedToWorld())
+            return true;
+    }
+
+    return false;
+}
+
+bool StaticCompound::isAnyRigidBodyAddedOrBeingAddedToWorld() const {
+    auto lock = sead::makeScopedLock(mCS);
+
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i) {
+        if (mFieldBodyGroups[i].isAnyRigidBodyBeingAddedToWorld() ||
+            mFieldBodyGroups[i].isAnyRigidBodyAddedToWorld()) {
+            return true;
+        }
+    }
+
+    return false;
+}
+
+void StaticCompound::removeFromWorld() {
+    auto lock = sead::makeScopedLock(mCS);
+
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].removeFromWorld();
+}
+
+void StaticCompound::addToWorld() {
+    auto lock = sead::makeScopedLock(mCS);
+
+    resetExtraTransformsAndApply();
+
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].addToWorld();
+}
+
+void StaticCompound::removeFromWorldImmediately() {
+    auto lock = sead::makeScopedLock(mCS);
+
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].removeFromWorldImmediately();
+}
+
+int StaticCompound::setMapObject(u32 hash_id, u32 srt_hash, map::Object* object) {
+    int idx = mStaticCompoundInfo->getActorIdx(hash_id, srt_hash);
+    if (idx >= 0 && idx < mMapObjects.size())
+        mMapObjects[idx] = object;
+    return idx;
+}
+
+map::Object* StaticCompound::getMapObject(int shape_idx) const {
+    auto* info = mStaticCompoundInfo->getShapeInfo(shape_idx);
+    if (!info)
+        return nullptr;
+
+    const int idx = info->m_ActorInfoIndex;
+    if (!mMapObjects.isIndexValid(idx))
+        return nullptr;
+
+    return mMapObjects[idx];
+}
+
+bool StaticCompound::setInstanceEnabled(int actor_idx, bool enabled) {
+    const int start = mStaticCompoundInfo->getShapeInfoStart(actor_idx);
+    const int end = mStaticCompoundInfo->getShapeInfoEnd(actor_idx);
+    for (int i = start; i <= end; ++i) {
+        auto* info = mStaticCompoundInfo->getShapeInfo(i);
+        if (!info || info->m_ActorInfoIndex < 0)
+            continue;
+
+        const auto group = info->m_BodyGroup;
+        const auto type = static_cast<BodyLayerType>(info->m_BodyLayerType);
+        const auto instance_id = info->m_InstanceId;
+
+        mFieldBodyGroups[group].setInstanceEnabled(type, instance_id, enabled);
+    }
+    return true;
+}
+
+void StaticCompound::processUpdates() {
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].processUpdates();
+}
+
+void StaticCompound::recomputeTransformMatrix() {
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].recomputeTransformMatrix();
+}
+
+void StaticCompound::applyExtraTransforms(const sead::Matrix34f& mtx) {
+    if (mtx == mMtx)
+        return;
+
+    mMtx = mtx;
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].applyExtraTransforms();
+}
+
+void StaticCompound::resetExtraTransformsAndApply() {
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i)
+        mFieldBodyGroups[i].resetExtraTransformsAndApply();
+}
+
+StaticCompoundRigidBodyGroup* StaticCompound::getFieldBodyGroup(int idx) {
+    return &mFieldBodyGroups[idx];
+}
+
+bool StaticCompound::hasFieldBodyGroup(const StaticCompoundRigidBodyGroup* group) const {
+    for (int i = 0, n = mFieldBodyGroups.size(); i < n; ++i) {
+        if (&mFieldBodyGroups[i] == group)
+            return true;
+    }
+    return false;
+}
+
+}  // namespace ksys::phys