ksys/phys: Start adding ClosestPointQuery and iterator stuff

1 files changed, 11 insertions, 0 deletions

diff --git a/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp b/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp
index 9a972ed7..c5098227 100644
--- a/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp
+++ b/src/KingSystem/Physics/System/physQueryContactPointInfo.cpp
@@ -1,4 +1,5 @@
 #include "KingSystem/Physics/System/physQueryContactPointInfo.h"
+#include "KingSystem/Physics/System/physContactMgr.h"
 
 namespace ksys::phys {
 
@@ -16,4 +17,14 @@ void QueryContactPointInfo::free(QueryContactPointInfo* info) {
 
 QueryContactPointInfo::~QueryContactPointInfo() = default;
 
+void QueryContactPointInfo::Iterator::getPointPosition(sead::Vector3f* out, Point point) const {
+    out->e = getPoint()->position.e;
+}
+
+sead::Vector3f QueryContactPointInfo::Iterator::getPointPosition(Point point) const {
+    sead::Vector3f pos;
+    getPointPosition(&pos, point);
+    return pos;
+}
+
 }  // namespace ksys::phys