1 files changed, 58 insertions, 0 deletions
diff --git a/src/peds/PedPlacement.cpp b/src/peds/PedPlacement.cpp
new file mode 100644
index 0000000..840d33f
--- /dev/null
+++ b/src/peds/PedPlacement.cpp
@@ -0,0 +1,58 @@
+#include "common.h"
+
+#include "Ped.h"
+#include "PedPlacement.h"
+#include "World.h"
+
+bool
+CPedPlacement::FindZCoorForPed(CVector* pos)
+{
+	float zForPed;
+	float startZ = pos->z - 100.0f;
+	float foundColZ = -100.0f;
+	float foundColZ2 = -100.0f;
+	CColPoint foundCol;
+	CEntity* foundEnt;
+
+	CVector vec(
+		pos->x,
+		pos->y,
+		pos->z + 1.0f
+	);
+
+	if (CWorld::ProcessVerticalLine(vec, startZ, foundCol, foundEnt, true, false, false, false, true, false, nil))
+		foundColZ = foundCol.point.z;
+
+	// Adjust coords and do a second test
+	vec.x += 0.1f;
+	vec.y += 0.1f;
+
+	if (CWorld::ProcessVerticalLine(vec, startZ, foundCol, foundEnt, true, false, false, false, true, false, nil))
+		foundColZ2 = foundCol.point.z;
+
+	zForPed = Max(foundColZ, foundColZ2);
+
+	if (zForPed > -99.0f) {
+		pos->z = FEET_OFFSET + zForPed;
+		return true;
+	}
+	return false;
+}
+
+CEntity*
+CPedPlacement::IsPositionClearOfCars(Const CVector *pos)
+{
+	return CWorld::TestSphereAgainstWorld(*pos, 0.25f, nil, true, true, false, false, false, false);
+}
+
+bool
+CPedPlacement::IsPositionClearForPed(const CVector& pos, float radius, int total, CEntity** entities)
+{
+	int16 count;
+	if (radius == -1.0f)
+		radius = 0.75f;
+	if (total == -1)
+		total = 2;
+	CWorld::FindObjectsKindaColliding(pos, radius, true, &count, total, entities, false, true, true, false, false);
+	return count == 0;
+}