Physics3D/PhysWorld3D: Add ForEachBodyInAABB method

2018-01-20 19:36:21 +01:00
parent c592acfd5f
commit b47f5210e0
2 changed files with 16 additions and 0 deletions
--- a/src/Nazara/Physics3D/PhysWorld3D.cpp
+++ b/src/Nazara/Physics3D/PhysWorld3D.cpp
@@ -36,6 +36,18 @@ namespace Nz
 		return materialId;
 	}

+	void PhysWorld3D::ForEachBodyInAABB(const Nz::Boxf& box, BodyIterator iterator)
+	{
+		auto NewtonCallback = [](const NewtonBody* const body, void* const userdata) -> int
+		{
+			BodyIterator& iterator = *static_cast<BodyIterator*>(userdata);
+			RigidBody3D* nzBody = static_cast<RigidBody3D*>(NewtonBodyGetUserData(body));
+			return iterator(*nzBody);
+		};
+
+		NewtonWorldForEachBodyInAABBDo(m_world, box.GetMinimum(), box.GetMaximum(), NewtonCallback, &iterator);
+	}
+
 	Vector3f PhysWorld3D::GetGravity() const
 	{
 		return m_gravity;