Method query

Source/Physics/PhysicsWorld.cpp:262–312

}

bool PhysicsWorld::query(const Rect& rect, const std::function<bool(Body*)>& callback) {
	AssertUnless(_world, "accessing invalid physics world.");
	auto& world = *_world;
	pd::AABB aabb{
		pd::AABB::Location{
			prVal(rect.getLeft()),
			prVal(rect.getBottom())},
		pd::AABB::Location{
			prVal(rect.getRight()),
			prVal(rect.getTop())}};
	pd::Transformation transform{
		pr::Length2{
			prVal(rect.getCenterX()),
			prVal(rect.getCenterY())}};
	pd::Shape testShape = pd::Shape{
		pd::PolygonShapeConf{
			prVal(rect.size.width),
			prVal(rect.size.height)}};
	pd::Query(pd::GetTree(world), aabb, [&](pr::BodyID bodyID, pr::ShapeID shapeID, const pr::ChildCounter) {
		BLOCK_START {
			BREAK_IF(pd::IsSensor(world, shapeID));
			const auto shapeType = pd::GetType(world, shapeID);
			bool isCommonShape = shapeType != pr::GetTypeID<pd::ChainShapeConf>() && shapeType != pr::GetTypeID<pd::EdgeShapeConf>();
			const auto shape = pd::GetShape(world, shapeID);
			BREAK_IF(isCommonShape && !pd::TestOverlap(pd::GetChild(testShape, 0), transform, pd::GetChild(shape, 0), pd::GetTransformation(world, bodyID)));
			Body* body = _bodyData[bodyID.get()];
			std::vector<Body*>& results = isCommonShape ? _queryResultsOfCommonShapes : _queryResultsOfChainsAndEdges;
			if (body && (results.empty() || results.back() != body)) {
				results.push_back(body);
			}
		}
		BLOCK_END
		return true;
	});
	bool result = false;
	for (Body* item : _queryResultsOfCommonShapes) {
		if (callback(item)) {
			result = true;
			break;
		}
	}
	for (Body* item : _queryResultsOfChainsAndEdges) {
		if (callback(item)) {
			result = true;
			break;
		}
	}
	_queryResultsOfCommonShapes.clear();
	_queryResultsOfChainsAndEdges.clear();
	return result;
}

bool PhysicsWorld::raycast(const Vec2& start, const Vec2& end, bool closest, const std::function<bool(Body*, const Vec2&, const Vec2&)>& callback) {
	AssertUnless(_world, "accessing invalid physics world.");