ksys/phys: Finish QueryContactPointInfo::Iterator

1 files changed, 16 insertions, 0 deletions

diff --git a/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp b/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp
index c5098227..121e2c25 100644
--- a/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp
+++ b/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp
@@ -1,5 +1,6 @@
 #include "KingSystem/Physics/System/physQueryContactPointInfo.h"
 #include "KingSystem/Physics/System/physContactMgr.h"
+#include "KingSystem/Physics/System/physShapeCast.h"
 
 namespace ksys::phys {
 
@@ -17,6 +18,21 @@ void QueryContactPointInfo::free(QueryContactPointInfo* info) {
 
 QueryContactPointInfo::~QueryContactPointInfo() = default;
 
+// NON_MATCHING: reordering
+void QueryContactPointInfo::Iterator::getHitPosition(sead::Vector3f* out,
+                                                     const ShapeCast& shape_cast) const {
+    float distance = getPoint()->separating_distance;
+    auto start = shape_cast.getStart();
+    auto end = shape_cast.getEnd();
+    *out = start + (end - start) * distance;
+}
+
+sead::Vector3f QueryContactPointInfo::Iterator::getHitPosition(const ShapeCast& shape_cast) const {
+    sead::Vector3f pos;
+    getHitPosition(&pos, shape_cast);
+    return pos;
+}
+
 void QueryContactPointInfo::Iterator::getPointPosition(sead::Vector3f* out, Point point) const {
     out->e = getPoint()->position.e;
 }