1 files changed, 34 insertions, 2 deletions

diff --git a/src/entities/PedIK.cpp b/src/entities/PedIK.cpp
index f262fab5..ebc17097 100644
--- a/src/entities/PedIK.cpp
+++ b/src/entities/PedIK.cpp
@@ -1,7 +1,39 @@
 #include "common.h"
 #include "patcher.h"
+#include "PedIK.h"
 #include "Ped.h"
 
-WRAPPER void CPedIK::GetComponentPosition(RwV3d* pos, int id) { EAXJMP(0x4ED0F0); }
 WRAPPER bool CPedIK::PointGunInDirection(float phi, float theta) { EAXJMP(0x4ED9B0); }
-WRAPPER bool CPedIK::PointGunAtPosition(CVector* position) { EAXJMP(0x4ED920); }
\ No newline at end of file
+WRAPPER bool CPedIK::PointGunAtPosition(CVector *position) { EAXJMP(0x4ED920); }
+
+void
+CPedIK::GetComponentPosition(RwV3d *pos, PedNode node)
+{
+	RwFrame *f;
+	RwMatrix *mat;
+
+	f = m_ped->GetNodeFrame(node);
+	mat = &f->modelling;
+	*pos = mat->pos;
+
+	for (f = RwFrameGetParent(f); f; f = RwFrameGetParent(f))
+		RwV3dTransformPoints(pos, pos, 1, &f->modelling);
+}
+
+RwMatrix*
+CPedIK::GetWorldMatrix(RwFrame *source, RwMatrix *destination)
+{
+	RwFrame *i;
+
+	*destination = source->modelling;
+
+	for (i = RwFrameGetParent(source); i; i = RwFrameGetParent(i))
+		RwMatrixTransform(destination, &i->modelling, rwCOMBINEPOSTCONCAT);
+
+	return destination;
+}
+
+STARTPATCHES
+	InjectHook(0x4ED0F0, &CPedIK::GetComponentPosition, PATCH_JUMP);
+	InjectHook(0x4ED060, &CPedIK::GetWorldMatrix, PATCH_JUMP);
+ENDPATCHES
\ No newline at end of file