/// <summary>
/// Call this to draw shapes and other debug draw data.
/// </summary>
void DrawDebugData()
{
if ((Flags & DebugViewFlags.Shape) == DebugViewFlags.Shape)
{
foreach (Body b in world.BodyList)
{
FarseerPhysics.Common.Transform xf;
b.GetTransform(out xf);
foreach (Fixture f in b.FixtureList)
{
if (b.Enabled == false)
{
DrawShape(f, xf, InactiveShapeColor);
}
else if (b.BodyType == BodyType.Static)
{
DrawShape(f, xf, StaticShapeColor);
}
else if (b.BodyType == BodyType.Kinematic)
{
DrawShape(f, xf, KinematicShapeColor);
}
else if (b.IsAwake == false)
{
DrawShape(f, xf, SleepingShapeColor);
}
else
{
DrawShape(f, xf, DefaultShapeColor);
}
}
}
}
if ((Flags & DebugViewFlags.ContactPoints) == DebugViewFlags.ContactPoints)
{
const float axisScale = 0.3f;
for (int i = 0; i < _pointCount; ++i)
{
ContactPoint point = _points[i];
if (point.State == PointState.Add)
{
DrawPoint(point.Position.ToXna(), 0.1f, new Color(0.3f, 0.95f, 0.3f));
}
else if (point.State == PointState.Persist)
{
DrawPoint(point.Position.ToXna(), 0.1f, new Color(0.3f, 0.3f, 0.95f));
}
if ((Flags & DebugViewFlags.ContactNormals) == DebugViewFlags.ContactNormals)
{
System.Numerics.Vector2 p1 = point.Position;
System.Numerics.Vector2 p2 = p1 + axisScale * point.Normal;
DrawSegment(p1, p2, new Color(0.4f, 0.9f, 0.4f));
}
}
_pointCount = 0;
}
if ((Flags & DebugViewFlags.PolygonPoints) == DebugViewFlags.PolygonPoints)
{
foreach (Body body in world.BodyList)
{
foreach (Fixture f in body.FixtureList)
{
var polygon = f.Shape as PolygonShape;
if (polygon != null)
{
FarseerPhysics.Common.Transform xf;
body.GetTransform(out xf);
for (int i = 0; i < polygon.Vertices.Count; i++)
{
System.Numerics.Vector2 tmp = MathUtils.Mul(ref xf, polygon.Vertices[i]);
DrawPoint(tmp.ToXna(), 0.1f, Color.Red);
}
}
}
}
}
if ((Flags & DebugViewFlags.Joint) == DebugViewFlags.Joint)
{
foreach (var j in world.JointList)
{
FSDebugView.DrawJoint(this, j);
}
}
if ((Flags & DebugViewFlags.AABB) == DebugViewFlags.AABB)
{
var color = new Color(0.9f, 0.3f, 0.9f);
var bp = world.ContactManager.BroadPhase;
foreach (var body in world.BodyList)
{
if (body.Enabled == false)
{
continue;
}
foreach (var f in body.FixtureList)
{
for (var t = 0; t < f.ProxyCount; ++t)
{
var proxy = f.Proxies[t];
AABB aabb;
bp.GetFatAABB(proxy.ProxyId, out aabb);
DrawAABB(ref aabb, color);
}
}
}
}
if ((Flags & DebugViewFlags.CenterOfMass) == DebugViewFlags.CenterOfMass)
{
foreach (Body b in world.BodyList)
{
FarseerPhysics.Common.Transform xf;
b.GetTransform(out xf);
xf.P = b.WorldCenter;
DrawTransform(ref xf);
}
}
if ((Flags & DebugViewFlags.Controllers) == DebugViewFlags.Controllers)
{
for (int i = 0; i < world.ControllerList.Count; i++)
{
Controller controller = world.ControllerList[i];
var buoyancy = controller as BuoyancyController;
if (buoyancy != null)
{
AABB container = buoyancy.Container;
DrawAABB(ref container, Color.LightBlue);
}
}
}
if ((Flags & DebugViewFlags.DebugPanel) == DebugViewFlags.DebugPanel)
{
DrawDebugPanel();
}
}
