3 files changed, 484 insertions, 2 deletions

diff --git a/src/KingSystem/Map/mapRail.cpp b/src/KingSystem/Map/mapRail.cpp
index 939707d6..2ddf960c 100644
--- a/src/KingSystem/Map/mapRail.cpp
+++ b/src/KingSystem/Map/mapRail.cpp
@@ -1 +1,299 @@
 #include "KingSystem/Map/mapRail.h"
+#include <heap/seadHeapMgr.h>
+#include "KingSystem/Utils/SafeDelete.h"
+
+namespace ksys::map {
+
+RailPoint::~RailPoint() = default;
+
+const MubinIter& RailPoint::getIter() const {
+    return mIter;
+}
+
+const sead::Vector3f& RailPoint::getRotate() const {
+    return mSRT.rotate;
+}
+
+const sead::Vector3f& RailPoint::getTranslate() const {
+    return mSRT.translate;
+}
+
+f32 RailPoint::getPrevDistance() const {
+    return mPrevDistance;
+}
+
+f32 RailPoint::getNextDistance() const {
+    return mNextDistance;
+}
+
+bool RailPoint::parse(MubinIter* iter, sead::Heap* heap) {
+    iter->getScale(&mSRT.scale);
+    iter->getRotate(&mSRT.rotate);
+
+    bool success = true;
+    success &= iter->tryGetFloatArrayByKey(mSRT.translate.e.data(), "Translate");
+    success &= iter->tryGetParamFloatByKey(&mPrevDistance, "PrevDistance");
+    success &= iter->tryGetParamFloatByKey(&mNextDistance, "NextDistance");
+    iter->tryGetControlPoints(&mCtrlPoints);
+
+    return success;
+}
+
+Rail::Rail() = default;
+
+Rail::~Rail() {
+    mRailPoints.freeBuffer();
+}
+
+void Rail::init(MubinIter* iter, sead::Heap* heap) {
+    parse(iter);
+
+    MubinIter result;
+    if (iter->tryGetParamIterByKey(&result, "RailPoints")) {
+        s32 size = result.getSize();
+        mRailPoints.allocBufferAssert(size, heap);
+        for (int i = 0; i < size; ++i) {
+            MubinIter node_iter;
+            if (result.tryGetIterByIndex(&node_iter, i)) {
+                RailPoint* point = allocPointIdx(i, heap);
+                point->mIter = node_iter;
+                point->parse(&node_iter, heap);
+            }
+        }
+    }
+
+    x_38();
+}
+
+RailPoint* Rail::allocPointIdx(s32 idx, sead::Heap* heap) {
+    mRailPoints[idx] = allocPoint(heap);
+    return mRailPoints[idx];
+}
+
+s32 Rail::getNumPoints() const {
+    return mRailPoints.size();
+}
+
+const RailPoint* Rail::getPoint(s32 idx) const {
+    if (idx < 0 || idx >= mRailPoints.size())
+        return nullptr;
+    return mRailPoints[idx];
+}
+
+RailPoint* Rail::getPoint(s32 idx) {
+    if (idx < 0 || idx >= mRailPoints.size())
+        return nullptr;
+    return mRailPoints[idx];
+}
+
+const SRT& Rail::getPointSRT(s32 idx) const {
+    return mRailPoints[idx]->mSRT;
+}
+
+const sead::Vector3f& Rail::getPointRotate(s32 idx) const {
+    return mRailPoints[idx]->mSRT.rotate;
+}
+
+const sead::Vector3f& Rail::getPointTranslate(s32 idx) const {
+    return mRailPoints[idx]->mSRT.translate;
+}
+
+const sead::Vector3f& Rail::getControlPoint(s32 rail_idx, s32 pt_idx) const {
+    return mRailPoints[rail_idx]->mCtrlPoints[pt_idx];
+}
+
+sead::Vector3f Rail::calcTranslate(float progress) const {
+    sead::Vector3f pos;
+    calcTranslateRotate(&pos, nullptr, progress);
+    return pos;
+}
+
+void Rail::calcTranslate(sead::Vector3f* pos_out, float progress) const {
+    calcTranslateRotate(pos_out, nullptr, progress);
+}
+
+bool Rail::isClosed() const {
+    return mFlags.isOn(Flag::Closed);
+}
+
+bool Rail::isBezier() const {
+    return mFlags.isOn(Flag::Bezier);
+}
+
+const u32& Rail::getHashId() const {
+    return mHashId;
+}
+
+const char* Rail::getUniqueName() const {
+    return mUniqueName;
+}
+
+RailPoint* Rail::allocPoint(sead::Heap* heap) {
+    return new (heap) RailPoint;
+}
+
+bool Rail::parse(MubinIter* iter) {
+    bool success = true;
+
+    success &= iter->tryGetParamUIntByKey(&mHashId, "HashId");
+    success &= iter->tryGetParamStringByKey(&mUniqueName, "UniqueName");
+
+    bool closed = false;
+    if (!iter->tryGetParamBoolByKey(&closed, "Closed")) {
+        success = false;
+    } else if (closed) {
+        mFlags.set(Flag::Closed);
+    } else {
+        mFlags.reset(Flag::Closed);
+    }
+
+    const char* type = nullptr;
+    if (!iter->tryGetParamStringByKey(&type, "RailType")) {
+        success = false;
+    } else {
+        mFlags.change(Flag::Bezier, sead::SafeString(type) == "Bezier");
+    }
+
+    return success;
+}
+
+bool RailGuidePoint::parse(MubinIter* iter, sead::Heap* heap) {
+    bool success = true;
+    success &= RailPoint::parse(iter, heap);
+    success &= iter->tryGetParamFloatByKey(&mWaitFrame, "WaitFrame");
+    return success;
+}
+
+RailGuide::RailGuide() = default;
+
+RailGuide::~RailGuide() = default;
+
+bool RailRemainGuidePoint::parse(MubinIter* iter, sead::Heap* heap) {
+    bool success = true;
+    success &= RailGuidePoint::parse(iter, heap);
+    success &= iter->tryGetParamFloatByKey(&mMoveSpeed, "MoveSpeed");
+    return success;
+}
+
+RailRemainGuide::RailRemainGuide() = default;
+
+RailRemainGuide::~RailRemainGuide() = default;
+
+RailPoint* RailRemainGuide::allocPoint(sead::Heap* heap) {
+    return new (heap) RailRemainGuidePoint;
+}
+
+RailConnectablePoint::RailConnectablePoint() = default;
+
+RailConnectablePoint::~RailConnectablePoint() {
+    sead::HeapMgr::instance()->getCurrentHeap();
+
+    if (mJunctionPoint)
+        util::safeDeleteArray(mJunctionPoint);
+}
+
+Rail* RailConnectablePoint::getJunctionRail() const {
+    return mJunctionRail;
+}
+
+RailPoint* RailConnectablePoint::getJunctionPoint() const {
+    return mJunctionPoint;
+}
+
+bool RailConnectablePoint::parse(MubinIter* iter, sead::Heap* heap) {
+    return RailPoint::parse(iter, heap);
+}
+
+RailRoutePoint::RailRoutePoint() = default;
+
+RailRoutePoint::~RailRoutePoint() = default;
+
+const char* RailRoutePoint::getCheckPointName() const {
+    return mCheckPointName;
+}
+
+bool RailRoutePoint::parse(MubinIter* iter, sead::Heap* heap) {
+    bool success = true;
+    success &= RailConnectablePoint::parse(iter, heap);
+    iter->tryGetParamStringByKey(&mEntryPointName, "EntryPointName");
+    iter->tryGetParamStringByKey(&mCheckPointName, "CheckPointName");
+    return success;
+}
+
+RailRoute::RailRoute() {
+    mFlags.set(Flag::AutoPlacementEnabled);
+    mFlags.set(Flag::EnableHorseTrace);
+    mFlags.set(Flag::Walkable);
+}
+
+RailRoute::~RailRoute() = default;
+
+bool RailRoute::isRenderEnabled() const {
+    return mFlags.isOn(Flag::RenderEnabled);
+}
+
+bool RailRoute::isAutoPlacementEnabled() const {
+    return mFlags.isOn(Flag::AutoPlacementEnabled);
+}
+
+bool RailRoute::isWalkable() const {
+    return mFlags.isOn(Flag::Walkable);
+}
+
+bool RailRoute::isHorseTraceEnabled() const {
+    return mFlags.isOn(Flag::EnableHorseTrace);
+}
+
+const char* RailRoute::getRouteId() const {
+    return mRouteId;
+}
+
+const char* RailRoute::getCheckPointName(s32 idx) const {
+    return static_cast<RailRoutePoint*>(mRailPoints[idx])->mCheckPointName;
+}
+
+bool RailRoute::parse(MubinIter* iter) {
+    int success = Rail::parse(iter);
+
+    bool result = false;
+    if (iter->tryGetParamBoolByKey(&result, "RenderEnabled")) {
+        if (result) {
+            mFlags.set(Flag::RenderEnabled);
+        } else {
+            mFlags.reset(Flag::RenderEnabled);
+        }
+    }
+
+    if (iter->tryGetParamBoolByKey(&result, "AutoPlacementEnabled")) {
+        if (result) {
+            mFlags.set(Flag::AutoPlacementEnabled);
+        } else {
+            mFlags.reset(Flag::AutoPlacementEnabled);
+        }
+    } else {
+        success = false;
+    }
+
+    if (iter->tryGetParamBoolByKey(&result, "IsWalkable")) {
+        if (result) {
+            mFlags.set(Flag::Walkable);
+        } else {
+            mFlags.reset(Flag::Walkable);
+        }
+    } else {
+        success = false;
+    }
+
+    if (iter->tryGetParamBoolByKey(&result, "IsEnableHorseTrace")) {
+        if (result) {
+            mFlags.set(Flag::EnableHorseTrace);
+        } else {
+            mFlags.reset(Flag::EnableHorseTrace);
+        }
+    }
+
+    success &= iter->tryGetParamStringByKey(&mRouteId, "RouteId");
+    return success;
+}
+
+}  // namespace ksys::map
diff --git a/src/KingSystem/Map/mapRail.h b/src/KingSystem/Map/mapRail.h
index dbbfca39..838b9039 100644
--- a/src/KingSystem/Map/mapRail.h
+++ b/src/KingSystem/Map/mapRail.h
@@ -1,7 +1,191 @@
 #pragma once
 
+#include <container/seadBuffer.h>
+#include <prim/seadTypedBitFlag.h>
+#include "KingSystem/Map/mapMubinIter.h"
+
 namespace ksys::map {
 
-class Rail {};
+class Placement18;
+
+class RailPoint {
+    friend class Rail;
+
+public:
+    RailPoint() {
+        mSRT.scale = sead::Vector3f::ones;
+        mSRT.rotate = sead::Vector3f::zero;
+        mSRT.translate = sead::Vector3f::zero;
+        mCtrlPoints[0] = sead::Vector3f::zero;
+        mCtrlPoints[1] = sead::Vector3f::zero;
+        mPrevDistance = 0.0;
+        mNextDistance = 0.0;
+    }
+    virtual ~RailPoint();
+    virtual bool parse(MubinIter* iter, sead::Heap* heap);
+
+    const MubinIter& getIter() const;
+    const sead::Vector3f& getRotate() const;
+    const sead::Vector3f& getTranslate() const;
+    f32 getPrevDistance() const;
+    f32 getNextDistance() const;
+
+protected:
+    SRT mSRT;
+    ControlPoints mCtrlPoints;
+    float mPrevDistance;
+    float mNextDistance;
+    MubinIter mIter;
+};
+
+class Rail {
+public:
+    Rail();
+    virtual ~Rail();
+    virtual void init(MubinIter* iter, sead::Heap* heap);
+    virtual s32 x_18() { return 0; }
+    virtual s32 x_20() { return 0; }
+    virtual RailPoint* allocPoint(sead::Heap* heap);
+    virtual bool parse(MubinIter* iter);
+    virtual void x_38() {}
+
+    RailPoint* allocPointIdx(s32 idx, sead::Heap* heap);
+    s32 getNumPoints() const;
+    const RailPoint* getPoint(s32 idx) const;
+    RailPoint* getPoint(s32 idx);
+
+    const SRT& getPointSRT(s32 idx) const;
+    const sead::Vector3f& getPointRotate(s32 idx) const;
+    const sead::Vector3f& getPointTranslate(s32 idx) const;
+    const sead::Vector3f& getControlPoint(s32 rail_idx, s32 pt_idx) const;
+
+    sead::Vector3f calcTranslate(float progress) const;
+    void calcTranslate(sead::Vector3f* pos_out, float progress) const;
+    void calcTranslateRotate(sead::Vector3f* pos_out, sead::Vector3f* rot_out,
+                             float progress) const;
+    bool isClosed() const;
+    bool isBezier() const;
+    const u32& getHashId() const;
+    const char* getUniqueName() const;
+
+    enum class Flag : u32 {
+        Closed = 1 << 0,
+        Bezier = 1 << 1,
+        RenderEnabled = 1 << 2,
+        AutoPlacementEnabled = 1 << 3,
+        Walkable = 1 << 4,
+        EnableHorseTrace = 1 << 5,
+    };
+
+protected:
+    static constexpr u32 sHashBase = 0;
+
+    sead::TypedBitFlag<Flag> mFlags{};
+    u32 mHashId = sHashBase;
+    const char* mUniqueName{};
+    sead::Buffer<RailPoint*> mRailPoints{};
+    MubinIter mIter{};
+};
+
+class RailGuidePoint : public RailPoint {
+    friend class RailGuide;
+
+public:
+    RailGuidePoint();
+    ~RailGuidePoint() override;
+
+    bool parse(MubinIter* iter, sead::Heap* heap) override;
+
+protected:
+    float mWaitFrame;
+};
+
+class RailRemainGuidePoint : public RailGuidePoint {
+    friend class RailRemainGuide;
+
+public:
+    RailRemainGuidePoint();
+    ~RailRemainGuidePoint() override;
+
+    bool parse(MubinIter* iter, sead::Heap* heap) override;
+
+protected:
+    float mMoveSpeed;
+};
+
+class RailGuide : public Rail {
+public:
+    RailGuide();
+    ~RailGuide() override;
+};
+
+class RailRemainGuide : public RailGuide {
+public:
+    RailRemainGuide();
+    ~RailRemainGuide() override;
+
+    RailPoint* allocPoint(sead::Heap* heap) override;
+};
+
+class RailConnectablePoint : public RailPoint {
+    friend class RailConnectable;
+
+public:
+    RailConnectablePoint();
+    ~RailConnectablePoint() override;
+
+    bool parse(MubinIter* iter, sead::Heap* heap) override;
+
+    Rail* getJunctionRail() const;
+    RailPoint* getJunctionPoint() const;
+    void parseJunctions(Placement18 p18, s32 idx, u32 hash, sead::Heap* heap);
+
+protected:
+    Rail* mJunctionRail;
+    RailPoint* mJunctionPoint;
+};
+
+class RailConnectable : public Rail {
+public:
+    RailConnectable();
+    ~RailConnectable() override;
+
+    s32 x_18() override { return 1; }
+    s32 x_20() override { return 1; }
+    void x_38() override {}
+};
+
+class RailRoutePoint : public RailConnectablePoint {
+    friend class RailRoute;
+
+public:
+    RailRoutePoint();
+    ~RailRoutePoint() override;
+
+    bool parse(MubinIter* iter, sead::Heap* heap) override;
+    const char* getCheckPointName() const;
+
+protected:
+    const char* mEntryPointName;
+    const char* mCheckPointName;
+};
+
+class RailRoute : public RailConnectable {
+public:
+    RailRoute();
+    ~RailRoute() override;
+
+    bool parse(MubinIter* iter) override;
+
+    bool isRenderEnabled() const;
+    bool isAutoPlacementEnabled() const;
+    bool isWalkable() const;
+    bool isHorseTraceEnabled() const;
+    const char* getRouteId() const;
+    const char* getCheckPointName(s32 idx) const;
+
+protected:
+    const char* mRouteId;
+};
 
 }  // namespace ksys::map
diff --git a/src/KingSystem/System/CMakeLists.txt b/src/KingSystem/System/CMakeLists.txt
index 1a53e941..4f907b81 100644
--- a/src/KingSystem/System/CMakeLists.txt
+++ b/src/KingSystem/System/CMakeLists.txt
@@ -62,4 +62,4 @@ target_sources(uking PRIVATE
     VFR.h
     VFRValue.cpp
     VFRValue.h
-    )
+)