vlad.os/LuaCsForBarotraumaEP
0
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Unstable 1.8.4.0

Browse Source
This commit is contained in:
Markus Isberg
2025-03-12 12:56:27 +00:00
parent a4c3e868e4
commit a4a3427e4e
627 changed files with 29860 additions and 10018 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Libraries/Farseer Physics Engine 3.5/Collision/DynamicTree.cs
+25 -9
View File
@@ -53,7 +53,7 @@ namespace FarseerPhysics.Collision
internal int Height;
internal int ParentOrNext;
public object Body;
public Body Body;
internal T UserData;
@@ -319,7 +319,7 @@ namespace FarseerPhysics.Collision
return _nodes[proxyId].AABB;
}
public object GetBody(int proxyId)
public Body GetBody(int proxyId)
{
Debug.Assert(0 <= proxyId && proxyId < _nodeCapacity);
return _nodes[proxyId].Body;
@@ -344,7 +344,7 @@ namespace FarseerPhysics.Collision
/// </summary>
/// <param name="callback">The callback.</param>
/// <param name="aabb">The aabb.</param>
public void Query(Func<int, bool> callback, ref AABB aabb, ref object body)
public void Query(Func<int, bool> callback, ref AABB aabb, ref Body body)
{
_queryStack.Clear();
_queryStack.Push(_root);
@@ -357,22 +357,38 @@ namespace FarseerPhysics.Collision
continue;
}
//TreeNode<T>* node = &_nodes[nodeId];
if (!ReferenceEquals(_nodes[nodeId].Body, body) && AABB.TestOverlap(ref _nodes[nodeId].AABB, ref aabb))
TreeNode<T> node = _nodes[nodeId];
if (node.Body != body && AABB.TestOverlap(ref node.AABB, ref aabb))
{
if (_nodes[nodeId].IsLeaf())
if (node.IsLeaf())
{
if (node.Body.CollidesWithMatchesBetweenFixtures &&
body.CollisionCategoriesMatchBetweenFixtures)
{
//equivalent to
//collide = node.Body.CollidesWith.HasAnyFlag(body.CollisionCategories) && body.CollidesWith.HasAnyFlag(node.Body.CollisionCategories)
//same check as in ContactManager.ShouldCollide
//inlined here using binary operations because this is performance critical code
bool collide =
(node.Body.CollidesWith & body.CollisionCategories) != 0 &&
(body.CollidesWith & node.Body.CollisionCategories) != 0;
if (!collide)
{
continue;
}
}
bool proceed = callback(nodeId);
if (proceed == false)
{
return;
}
}
else
{
_queryStack.Push(_nodes[nodeId].Child1);
_queryStack.Push(_nodes[nodeId].Child2);
}
_queryStack.Push(node.Child1);
_queryStack.Push(node.Child2);
}
}
}
}