< Summary

Line coverage
100%
Covered lines: 904
Uncovered lines: 0
Coverable lines: 904
Total lines: 1394
Line coverage: 100%
Branch coverage
100%
Covered branches: 208
Total branches: 208
Branch coverage: 100%
Method coverage

Feature is only available for sponsors

Upgrade to PRO version

Metrics

MethodBranch coverage Crap Score Cyclomatic complexity Line coverage
File 1: .ctor(...)100%11100%
File 1: get_Events()100%11100%
File 1: get_DrawCommands()100%11100%
File 1: DispatchEventsTo(...)100%44100%
File 1: DispatchDrawCommandsTo(...)100%44100%
File 1: get_EventCount()100%11100%
File 1: get_DrawCommandCount()100%11100%
File 1: get_EventCapacity()100%11100%
File 1: get_DrawCommandCapacity()100%11100%
File 1: Enable(...)100%44100%
File 1: Disable()100%11100%
File 1: Clear()100%11100%
File 1: Reset()100%11100%
File 1: EmitForceDelta(...)100%22100%
File 1: EmitTorqueDelta(...)100%22100%
File 1: EmitLinearVelocityDelta(...)100%22100%
File 1: EmitAngularVelocityDelta(...)100%22100%
File 1: EmitGroundProbe(...)100%88100%
File 1: EmitGroundProbe(...)100%88100%
File 1: EmitRayQuery(...)100%88100%
File 1: EmitCircleQuery(...)100%88100%
File 1: EmitQuerySummary(...)100%22100%
File 1: EmitContact(...)100%88100%
File 1: EmitResponseImpulse(...)100%44100%
File 1: EmitMixedQuery(...)100%1818100%
File 1: EmitMixedContact(...)100%22100%
File 1: EmitMixedResponseImpulse(...)100%22100%
File 1: EmitMixedResponseIsland(...)100%22100%
File 1: EmitJointRegistered(...)100%22100%
File 1: EmitJointRegistered(...)100%22100%
File 1: EmitJointRemoved(...)100%22100%
File 1: EmitJointRemoved(...)100%22100%
File 1: EmitJointImpulse(...)100%22100%
File 1: EmitJointImpulse(...)100%22100%
File 1: EmitJointLimitReached(...)100%22100%
File 1: EmitJointLimitReached(...)100%22100%
File 1: EmitRagdollActivated(...)100%22100%
File 1: AddEvent(...)100%11100%
File 1: AddDrawCommand(...)100%11100%
File 1: ResolveDimension(...)100%44100%
File 1: ToDiagnosticVector(...)100%11100%
File 2: CaptureCollider(...)100%1616100%
File 2: CaptureMixedCollider(...)100%1010100%
File 2: CaptureJoint(...)100%66100%
File 2: CaptureJoint(...)100%44100%
File 2: CaptureLine(...)100%22100%
File 2: CaptureRay(...)100%44100%
File 2: CapturePoint(...)100%22100%
File 2: CaptureMeshTriangles(...)100%44100%
File 2: CaptureJointAxis(...)100%11100%
File 2: CaptureCompoundParts(...)100%1414100%
File 2: CaptureCompoundMeshTriangles(...)100%44100%
File 2: CaptureMixedCompoundParts(...)100%88100%
File 2: CaptureMixedCapsule(...)100%1010100%
File 2: CaptureMixedPolygon(...)100%11100%
File 2: CaptureMixedPolygon(...)100%1212100%

File(s)

/home/runner/work/Gravitas/Gravitas/src/Gravitas/Diagnostics/GravitasDiagnosticSink.cs

#LineLine coverage
 1//=======================================================================
 2// GravitasDiagnosticSink.cs
 3//=======================================================================
 4// MIT License, Copyright (c) 2026-present David Oravsky (mrdav30)
 5// See LICENSE file in the project root for full license information.
 6//=======================================================================
 7
 8using System;
 9using FixedMathSharp;
 10using Gravitas.Colliders;
 11using Gravitas.CollisionHandling;
 12using Gravitas.Constraints;
 13using Gravitas.Queries;
 14using SwiftCollections;
 15
 16namespace Gravitas.Diagnostics;
 17
 18/// <summary>
 19/// Context-owned deterministic diagnostics buffer for physics events and debug draw commands.
 20/// </summary>
 21public sealed partial class GravitasDiagnosticSink
 22{
 23    private readonly GravitasWorldContext _context;
 1019124    private readonly SwiftList<GravitasDiagnosticEvent> _events = new();
 1019125    private readonly SwiftList<GravitasDebugDrawCommand> _drawCommands = new();
 26    private int _eventSequence;
 27    private int _drawSequence;
 28
 1019129    internal GravitasDiagnosticSink(GravitasWorldContext context)
 30    {
 1019131        ChronicleGuard.ThrowIfNull(context, nameof(context));
 1019132        _context = context;
 1019133    }
 34
 35    /// <summary>
 36    /// Gets whether this sink records events and draw commands.
 37    /// </summary>
 38    public bool Enabled { get; private set; }
 39
 40    /// <summary>
 41    /// Gets captured diagnostic events for this context.
 42    /// </summary>
 43    /// <remarks>
 44    /// Borrows sink-owned storage. Consume before further capture, clear,
 45    /// disable, or context reset; copy the data when retaining it.
 46    /// </remarks>
 28147    public ReadOnlySpan<GravitasDiagnosticEvent> Events => _events.AsReadOnlySpan();
 48
 49    /// <summary>
 50    /// Gets captured engine-agnostic draw commands for this context.
 51    /// </summary>
 52    /// <remarks>
 53    /// Borrows sink-owned storage. Consume before further capture, clear,
 54    /// disable, or context reset; copy the data when retaining it.
 55    /// </remarks>
 4556    public ReadOnlySpan<GravitasDebugDrawCommand> DrawCommands => _drawCommands.AsReadOnlySpan();
 57
 58    /// <summary>
 59    /// Dispatches captured events in buffer order to a typed diagnostic visitor.
 60    /// </summary>
 61    public void DispatchEventsTo(GravitasDiagnosticEventVisitor visitor)
 62    {
 263        if (visitor == null)
 164            throw new ArgumentNullException(nameof(visitor));
 65
 166        ReadOnlySpan<GravitasDiagnosticEvent> events = Events;
 667        for (int i = 0; i < events.Length; i++)
 268            events[i].DispatchTo(visitor);
 169    }
 70
 71    /// <summary>
 72    /// Dispatches captured draw commands in buffer order to a typed debug draw visitor.
 73    /// </summary>
 74    public void DispatchDrawCommandsTo(GravitasDebugDrawCommandVisitor visitor)
 75    {
 276        if (visitor == null)
 177            throw new ArgumentNullException(nameof(visitor));
 78
 179        ReadOnlySpan<GravitasDebugDrawCommand> commands = DrawCommands;
 680        for (int i = 0; i < commands.Length; i++)
 281            commands[i].DispatchTo(visitor);
 182    }
 83
 84    /// <summary>Gets the number of captured diagnostic events.</summary>
 3685    public int EventCount => _events.Count;
 86
 87    /// <summary>Gets the number of captured debug draw commands.</summary>
 888    public int DrawCommandCount => _drawCommands.Count;
 89
 390    internal int EventCapacity => _events.Capacity;
 91
 492    internal int DrawCommandCapacity => _drawCommands.Capacity;
 93
 94    /// <summary>
 95    /// Enables diagnostics and optionally reserves buffer capacity for hot-path capture.
 96    /// </summary>
 97    public void Enable(int eventCapacity = 128, int drawCommandCapacity = 128)
 98    {
 17499        Enabled = true;
 174100        if (eventCapacity > 0)
 152101            _events.EnsureCapacity(eventCapacity);
 174102        if (drawCommandCapacity > 0)
 132103            _drawCommands.EnsureCapacity(drawCommandCapacity);
 174104    }
 105
 106    /// <summary>
 107    /// Disables diagnostics and clears captured data.
 108    /// </summary>
 109    public void Disable()
 110    {
 5111        Enabled = false;
 5112        Clear();
 5113    }
 114
 115    /// <summary>
 116    /// Clears captured data while retaining allocated buffer capacity.
 117    /// </summary>
 118    public void Clear()
 119    {
 159120        _events.FastClear();
 159121        _drawCommands.FastClear();
 159122        _eventSequence = 0;
 159123        _drawSequence = 0;
 159124    }
 125
 113126    internal void Reset() => Clear();
 127
 128    internal void EmitForceDelta(SolidBody body, Vector3d force, Vector3d accelerationDelta)
 129    {
 2157130        if (!Enabled)
 2151131            return;
 132
 6133        AddEvent(
 6134            GravitasDiagnosticEventKind.ForceDelta,
 6135            bodyId: body.DynamicId,
 6136            colliderAId: body.Collider.Id,
 6137            colliderAType: body.Collider.Shape,
 6138            vector: force,
 6139            pointA: accelerationDelta,
 6140            scalarA: force.Magnitude);
 6141    }
 142
 143    internal void EmitTorqueDelta(SolidBody body, Vector3d torque)
 144    {
 114145        if (!Enabled)
 108146            return;
 147
 6148        AddEvent(
 6149            GravitasDiagnosticEventKind.TorqueDelta,
 6150            bodyId: body.DynamicId,
 6151            colliderAId: body.Collider.Id,
 6152            colliderAType: body.Collider.Shape,
 6153            vector: torque,
 6154            scalarA: torque.Magnitude);
 6155    }
 156
 157    internal void EmitLinearVelocityDelta(SolidBody body, Vector3d before, Vector3d after)
 158    {
 450764159        if (!Enabled)
 450593160            return;
 161
 171162        AddEvent(
 171163            GravitasDiagnosticEventKind.LinearVelocityDelta,
 171164            bodyId: body.DynamicId,
 171165            colliderAId: body.Collider.Id,
 171166            colliderAType: body.Collider.Shape,
 171167            start: before,
 171168            end: after,
 171169            vector: after - before,
 171170            scalarA: after.Magnitude);
 171171    }
 172
 173    internal void EmitAngularVelocityDelta(SolidBody body, Vector3d before, Vector3d after)
 174    {
 378732175        if (!Enabled)
 378471176            return;
 177
 261178        AddEvent(
 261179            GravitasDiagnosticEventKind.AngularVelocityDelta,
 261180            bodyId: body.DynamicId,
 261181            colliderAId: body.Collider.Id,
 261182            colliderAType: body.Collider.Shape,
 261183            start: before,
 261184            end: after,
 261185            vector: after - before,
 261186            scalarA: after.Magnitude);
 261187    }
 188
 189    internal void EmitGroundProbe(
 190        SolidBody body,
 191        GroundProbeMode mode,
 192        Vector3d origin,
 193        Vector3d end,
 194        Fixed64 radius,
 195        bool hit,
 196        Physics3DHit raycastHit)
 197    {
 13782198        if (!Enabled)
 13692199            return;
 200
 90201        Vector3d point = default;
 90202        bool hasPoint = hit && raycastHit.TryGetPoint(out point);
 90203        AddEvent(
 90204            GravitasDiagnosticEventKind.GroundProbe,
 90205            bodyId: body.DynamicId,
 90206            colliderAId: body.Collider.Id,
 90207            colliderBId: raycastHit.Collider?.Id ?? -1,
 90208            colliderAType: body.Collider.Shape,
 90209            colliderBType: raycastHit.Collider?.Shape ?? ColliderType.None,
 90210            start: origin,
 90211            end: end,
 90212            pointA: point,
 90213            hasPointA: hasPoint,
 90214            vector: raycastHit.Normal,
 90215            scalarA: radius,
 90216            scalarB: raycastHit.Distance,
 90217            dataA: (int)mode,
 90218            hit: hit);
 90219    }
 220
 221    internal void EmitGroundProbe(
 222        SolidBody2D body,
 223        GroundProbeMode2D mode,
 224        Vector2d start,
 225        Vector2d end,
 226        Fixed64 radius,
 227        bool hit,
 228        Physics2DHit raycastHit)
 229    {
 7575230        if (!Enabled)
 7507231            return;
 232
 68233        AddEvent(
 68234            GravitasDiagnosticEventKind.GroundProbe,
 68235            bodyId: body.DynamicId,
 68236            colliderAId: body.Collider.Id,
 68237            colliderBId: raycastHit.Collider?.Id ?? -1,
 68238            colliderADimension: GravitasColliderDimension.TwoD,
 68239            colliderBDimension: raycastHit.Collider == null ? GravitasColliderDimension.None : GravitasColliderDimension
 68240            colliderA2DType: body.Collider.Shape,
 68241            colliderB2DType: raycastHit.Collider?.Shape ?? ColliderType2D.None,
 68242            start: ToDiagnosticVector(start),
 68243            end: ToDiagnosticVector(end),
 68244            pointA: ToDiagnosticVector(raycastHit.Point),
 68245            hasPointA: hit,
 68246            vector: ToDiagnosticVector(raycastHit.Normal),
 68247            scalarA: radius,
 68248            scalarB: raycastHit.Distance,
 68249            dataA: (int)mode,
 68250            dataB: (int)GravitasColliderDimension.TwoD,
 68251            hit: hit);
 68252    }
 253
 254    internal void EmitRayQuery(
 255        Vector3d start,
 256        Vector3d end,
 257        Fixed64 radius,
 258        int layerMaskBits,
 259        bool hit,
 260        int hitCount,
 261        Physics3DHit raycastHit)
 262    {
 26793263        if (!Enabled)
 26682264            return;
 265
 111266        Vector3d point = default;
 111267        bool hasPoint = hit && raycastHit.TryGetPoint(out point);
 111268        AddEvent(
 111269            GravitasDiagnosticEventKind.RayQuery,
 111270            colliderAId: raycastHit.Collider?.Id ?? -1,
 111271            colliderAType: raycastHit.Collider?.Shape ?? ColliderType.None,
 111272            start: start,
 111273            end: end,
 111274            pointA: point,
 111275            hasPointA: hasPoint,
 111276            vector: raycastHit.Normal,
 111277            scalarA: radius,
 111278            scalarB: raycastHit.Distance,
 111279            dataA: layerMaskBits,
 111280            dataB: hitCount,
 111281            hit: hit);
 111282    }
 283
 284    internal void EmitCircleQuery(
 285        Vector3d center,
 286        Fixed64 radius,
 287        Vector3d direction,
 288        Fixed64 maxDistance,
 289        int layerMaskBits,
 290        bool hit,
 291        int hitCount,
 292        Physics3DHit raycastHit)
 293    {
 41294        if (!Enabled)
 37295            return;
 296
 4297        Vector3d point = default;
 4298        bool hasPoint = hit && raycastHit.TryGetPoint(out point);
 4299        AddEvent(
 4300            GravitasDiagnosticEventKind.CircleQuery,
 4301            colliderAId: raycastHit.Collider?.Id ?? -1,
 4302            colliderAType: raycastHit.Collider?.Shape ?? ColliderType.None,
 4303            start: center,
 4304            end: center + direction * maxDistance,
 4305            pointA: point,
 4306            hasPointA: hasPoint,
 4307            vector: direction,
 4308            scalarA: radius,
 4309            scalarB: raycastHit.Distance,
 4310            dataA: layerMaskBits,
 4311            dataB: hitCount,
 4312            hit: hit);
 4313    }
 314
 315    internal void EmitQuerySummary(
 316        GravitasColliderDimension sourceDimension,
 317        GravitasColliderDimension targetDimension,
 318        Vector3d start,
 319        Vector3d end,
 320        int exactReducerAttempts,
 321        int acceptedHits,
 322        int fallbackHits,
 323        int rejectedConservativeCandidates)
 324    {
 6325        AddEvent(
 6326            GravitasDiagnosticEventKind.QuerySummary,
 6327            colliderADimension: sourceDimension,
 6328            colliderBDimension: targetDimension,
 6329            start: start,
 6330            end: end,
 6331            scalarA: (Fixed64)fallbackHits,
 6332            scalarB: (Fixed64)rejectedConservativeCandidates,
 6333            dataA: exactReducerAttempts,
 6334            dataB: acceptedHits,
 6335            hit: fallbackHits > 0 || rejectedConservativeCandidates > 0);
 6336    }
 337
 338    internal void EmitContact(CollisionPair pair, bool hit)
 339    {
 52815340        if (!Enabled)
 52798341            return;
 342
 17343        bool hasContact = pair.Manifold.HasContact;
 17344        ManifoldContact contact = hasContact
 17345            ? pair.Manifold.PrimaryContact
 17346            : default;
 17347        Vector3d pointA = default;
 17348        Vector3d pointB = default;
 17349        bool hasPointA = hasContact && contact.TryGetPointA(out pointA);
 17350        bool hasPointB = hasContact && contact.TryGetPointB(out pointB);
 351
 17352        AddEvent(
 17353            GravitasDiagnosticEventKind.Contact,
 17354            colliderAId: pair.ColliderA.Id,
 17355            colliderBId: pair.ColliderB.Id,
 17356            colliderAType: pair.ColliderA.Shape,
 17357            colliderBType: pair.ColliderB.Shape,
 17358            pointA: pointA,
 17359            pointB: pointB,
 17360            hasPointA: hasPointA,
 17361            hasPointB: hasPointB,
 17362            vector: contact.Normal,
 17363            scalarA: contact.Depth,
 17364            dataA: pair.Manifold.Count,
 17365            dataB: contact.DepthIsClamped ? 1 : 0,
 17366            hit: hit && hasContact);
 17367    }
 368
 369    internal void EmitResponseImpulse(CollisionPair pair, Vector3d impulse, Fixed64 normalVelocity,
 370        ManifoldContact? sample = null)
 371    {
 57274372        if (!Enabled)
 57233373            return;
 374
 41375        ManifoldContact contact = sample ?? pair.Manifold.PrimaryContact;
 41376        bool hasPointA = contact.TryGetPointA(out Vector3d pointA);
 41377        bool hasPointB = contact.TryGetPointB(out Vector3d pointB);
 378
 41379        AddEvent(
 41380            GravitasDiagnosticEventKind.ResponseImpulse,
 41381            colliderAId: pair.ColliderA.Id,
 41382            colliderBId: pair.ColliderB.Id,
 41383            colliderAType: pair.ColliderA.Shape,
 41384            colliderBType: pair.ColliderB.Shape,
 41385            pointA: pointA,
 41386            pointB: pointB,
 41387            hasPointA: hasPointA,
 41388            hasPointB: hasPointB,
 41389            vector: impulse,
 41390            scalarA: impulse.Magnitude,
 41391            scalarB: normalVelocity,
 41392            hit: true);
 41393    }
 394
 395    internal void EmitMixedQuery(
 396        Vector3d start,
 397        Vector3d end,
 398        Fixed64 radius,
 399        int layerMaskBits,
 400        bool hit,
 401        int hitCount,
 402        PhysicsMixedHit mixedHit)
 403    {
 2660404        if (!Enabled)
 2655405            return;
 406
 5407        Vector3d point3D = default;
 5408        Vector3d point2D = default;
 5409        bool hasPoint3D = hit && mixedHit.TryGetPoint3D(out point3D);
 5410        bool hasPoint2D = hit && mixedHit.TryGetPoint2D(out point2D);
 5411        AddEvent(
 5412            GravitasDiagnosticEventKind.MixedQuery,
 5413            colliderAId: mixedHit.Collider3D?.Id ?? -1,
 5414            colliderBId: mixedHit.Collider2D?.Id ?? -1,
 5415            colliderADimension: mixedHit.Collider3D == null ? GravitasColliderDimension.None : GravitasColliderDimension
 5416            colliderBDimension: mixedHit.Collider2D == null ? GravitasColliderDimension.None : GravitasColliderDimension
 5417            colliderAType: mixedHit.Collider3D?.Shape ?? ColliderType.None,
 5418            colliderB2DType: mixedHit.Collider2D?.Shape ?? ColliderType2D.None,
 5419            start: start,
 5420            end: end,
 5421            pointA: point3D,
 5422            pointB: point2D,
 5423            hasPointA: hasPoint3D,
 5424            hasPointB: hasPoint2D,
 5425            vector: mixedHit.Normal3DTo2D,
 5426            scalarA: radius,
 5427            scalarB: mixedHit.Distance,
 5428            dataA: layerMaskBits,
 5429            dataB: hitCount,
 5430            hit: hit);
 5431    }
 432
 433    internal void EmitMixedContact(CollisionPairMixed pair, MixedContact contact)
 434    {
 16102435        if (!Enabled)
 16079436            return;
 437
 23438        bool hasPoint3D = contact.TryGetPoint3D(out Vector3d point3D);
 23439        bool hasPoint2D = contact.TryGetPoint2D(out Vector3d point2D);
 23440        AddEvent(
 23441            GravitasDiagnosticEventKind.MixedContact,
 23442            colliderAId: pair.Collider3DId,
 23443            colliderBId: pair.Collider2DId,
 23444            colliderADimension: GravitasColliderDimension.ThreeD,
 23445            colliderBDimension: GravitasColliderDimension.TwoD,
 23446            colliderAType: pair.Collider3D.Shape,
 23447            colliderB2DType: pair.Collider2D.Shape,
 23448            pointA: point3D,
 23449            pointB: point2D,
 23450            hasPointA: hasPoint3D,
 23451            hasPointB: hasPoint2D,
 23452            vector: contact.Normal3DTo2D,
 23453            scalarA: contact.Depth,
 23454            dataA: contact.DepthIsClamped ? 1 : 0,
 23455            hit: true);
 23456    }
 457
 458    internal void EmitMixedResponseImpulse(
 459        CollisionPairMixed pair,
 460        MixedContact contact,
 461        Vector3d impulse,
 462        Fixed64 normalVelocity,
 463        int iteration,
 464        int iterationLimit)
 465    {
 17853466        if (!Enabled)
 17837467            return;
 468
 16469        bool hasPoint3D = contact.TryGetPoint3D(out Vector3d point3D);
 16470        bool hasPoint2D = contact.TryGetPoint2D(out Vector3d point2D);
 16471        AddEvent(
 16472            GravitasDiagnosticEventKind.MixedResponseImpulse,
 16473            colliderAId: pair.Collider3DId,
 16474            colliderBId: pair.Collider2DId,
 16475            colliderADimension: GravitasColliderDimension.ThreeD,
 16476            colliderBDimension: GravitasColliderDimension.TwoD,
 16477            colliderAType: pair.Collider3D.Shape,
 16478            colliderB2DType: pair.Collider2D.Shape,
 16479            pointA: point3D,
 16480            pointB: point2D,
 16481            hasPointA: hasPoint3D,
 16482            hasPointB: hasPoint2D,
 16483            vector: impulse,
 16484            scalarA: impulse.Magnitude,
 16485            scalarB: normalVelocity,
 16486            dataA: iteration,
 16487            dataB: iterationLimit,
 16488            hit: true);
 16489    }
 490
 491    internal void EmitMixedResponseIsland(
 492        int rootKey,
 493        int constraintCount,
 494        int iterationCount,
 495        bool reachedIterationLimit)
 496    {
 1144497        if (!Enabled)
 1137498            return;
 499
 7500        AddEvent(
 7501            GravitasDiagnosticEventKind.MixedResponseIsland,
 7502            bodyId: rootKey,
 7503            dataA: constraintCount,
 7504            dataB: iterationCount,
 7505            hit: reachedIterationLimit);
 7506    }
 507
 508    internal void EmitJointRegistered(Joint3D joint)
 509    {
 372510        if (!Enabled)
 367511            return;
 512
 5513        AddEvent(
 5514            GravitasDiagnosticEventKind.JointRegistered,
 5515            jointId: joint.Id,
 5516            colliderAId: joint.BodyA.Collider.Id,
 5517            colliderBId: joint.BodyB.Collider.Id,
 5518            colliderAType: joint.BodyA.Collider.Shape,
 5519            colliderBType: joint.BodyB.Collider.Shape,
 5520            dataA: (int)joint.Type,
 5521            dataB: (int)joint.CollisionPolicy);
 5522    }
 523
 524    internal void EmitJointRegistered(Joint2D joint)
 525    {
 214526        if (!Enabled)
 209527            return;
 528
 5529        AddEvent(
 5530            GravitasDiagnosticEventKind.JointRegistered,
 5531            jointId: joint.Id,
 5532            colliderAId: joint.BodyA.Collider.Id,
 5533            colliderBId: joint.BodyB.Collider.Id,
 5534            colliderADimension: GravitasColliderDimension.TwoD,
 5535            colliderBDimension: GravitasColliderDimension.TwoD,
 5536            colliderA2DType: joint.BodyA.Collider.Shape,
 5537            colliderB2DType: joint.BodyB.Collider.Shape,
 5538            dataA: (int)joint.Type,
 5539            dataB: (int)joint.CollisionPolicy);
 5540    }
 541
 542    internal void EmitJointRemoved(Joint3D joint)
 543    {
 29544        if (!Enabled)
 24545            return;
 546
 5547        AddEvent(
 5548            GravitasDiagnosticEventKind.JointRemoved,
 5549            jointId: joint.Id,
 5550            colliderAId: joint.BodyA.Collider.Id,
 5551            colliderBId: joint.BodyB.Collider.Id,
 5552            colliderAType: joint.BodyA.Collider.Shape,
 5553            colliderBType: joint.BodyB.Collider.Shape,
 5554            dataA: (int)joint.Type,
 5555            dataB: (int)joint.CollisionPolicy);
 5556    }
 557
 558    internal void EmitJointRemoved(Joint2D joint)
 559    {
 29560        if (!Enabled)
 24561            return;
 562
 5563        AddEvent(
 5564            GravitasDiagnosticEventKind.JointRemoved,
 5565            jointId: joint.Id,
 5566            colliderAId: joint.BodyA.Collider.Id,
 5567            colliderBId: joint.BodyB.Collider.Id,
 5568            colliderADimension: GravitasColliderDimension.TwoD,
 5569            colliderBDimension: GravitasColliderDimension.TwoD,
 5570            colliderA2DType: joint.BodyA.Collider.Shape,
 5571            colliderB2DType: joint.BodyB.Collider.Shape,
 5572            dataA: (int)joint.Type,
 5573            dataB: (int)joint.CollisionPolicy);
 5574    }
 575
 576    internal void EmitJointImpulse(Joint3D joint, JointSolveMetrics3D metrics)
 577    {
 74265578        if (!Enabled)
 74132579            return;
 580
 133581        AddEvent(
 133582            GravitasDiagnosticEventKind.JointImpulse,
 133583            jointId: joint.Id,
 133584            colliderAId: joint.BodyA.Collider.Id,
 133585            colliderBId: joint.BodyB.Collider.Id,
 133586            colliderAType: joint.BodyA.Collider.Shape,
 133587            colliderBType: joint.BodyB.Collider.Shape,
 133588            vector: new Vector3d(
 133589                metrics.MotorImpulseMagnitude,
 133590                metrics.MotorErrorMagnitude,
 133591                metrics.AngularLimitErrorMagnitude),
 133592            scalarA: metrics.AccumulatedImpulseMagnitude,
 133593            scalarB: metrics.LinearAnchorErrorMagnitude,
 133594            dataA: metrics.PreparedRowCount,
 133595            dataB: metrics.ClampedRowCount,
 133596            hit: metrics.IncrementalImpulseMagnitude > Fixed64.Zero);
 133597    }
 598
 599    internal void EmitJointImpulse(Joint2D joint, JointSolveMetrics2D metrics)
 600    {
 608601        if (!Enabled)
 603602            return;
 603
 5604        AddEvent(
 5605            GravitasDiagnosticEventKind.JointImpulse,
 5606            jointId: joint.Id,
 5607            colliderAId: joint.BodyA.Collider.Id,
 5608            colliderBId: joint.BodyB.Collider.Id,
 5609            colliderADimension: GravitasColliderDimension.TwoD,
 5610            colliderBDimension: GravitasColliderDimension.TwoD,
 5611            colliderA2DType: joint.BodyA.Collider.Shape,
 5612            colliderB2DType: joint.BodyB.Collider.Shape,
 5613            vector: new Vector3d(
 5614                metrics.MotorImpulseMagnitude,
 5615                metrics.MotorErrorMagnitude,
 5616                metrics.LimitErrorMagnitude),
 5617            scalarA: metrics.AccumulatedImpulseMagnitude,
 5618            scalarB: metrics.LinearAnchorErrorMagnitude,
 5619            dataA: metrics.PreparedRowCount,
 5620            dataB: metrics.ClampedRowCount,
 5621            hit: metrics.IncrementalImpulseMagnitude > Fixed64.Zero);
 5622    }
 623
 624    internal void EmitJointLimitReached(Joint3D joint, Fixed64 limitError)
 625    {
 121626        if (!Enabled)
 120627            return;
 628
 1629        AddEvent(
 1630            GravitasDiagnosticEventKind.JointLimitReached,
 1631            jointId: joint.Id,
 1632            colliderAId: joint.BodyA.Collider.Id,
 1633            colliderBId: joint.BodyB.Collider.Id,
 1634            colliderAType: joint.BodyA.Collider.Shape,
 1635            colliderBType: joint.BodyB.Collider.Shape,
 1636            scalarB: limitError,
 1637            dataA: (int)joint.Limits.Kind,
 1638            hit: limitError != Fixed64.Zero);
 1639    }
 640
 641    internal void EmitJointLimitReached(Joint2D joint, Fixed64 limitError)
 642    {
 161643        if (!Enabled)
 160644            return;
 645
 1646        AddEvent(
 1647            GravitasDiagnosticEventKind.JointLimitReached,
 1648            jointId: joint.Id,
 1649            colliderAId: joint.BodyA.Collider.Id,
 1650            colliderBId: joint.BodyB.Collider.Id,
 1651            colliderADimension: GravitasColliderDimension.TwoD,
 1652            colliderBDimension: GravitasColliderDimension.TwoD,
 1653            colliderA2DType: joint.BodyA.Collider.Shape,
 1654            colliderB2DType: joint.BodyB.Collider.Shape,
 1655            scalarB: limitError,
 1656            dataA: (int)joint.Limits.Kind,
 1657            hit: limitError != Fixed64.Zero);
 1658    }
 659
 660    internal void EmitRagdollActivated(int ragdollId, int linkCount, int jointCount, bool isActive)
 661    {
 16662        if (!Enabled)
 11663            return;
 664
 5665        AddEvent(
 5666            GravitasDiagnosticEventKind.RagdollActivated,
 5667            bodyId: ragdollId,
 5668            dataA: linkCount,
 5669            dataB: jointCount,
 5670            hit: isActive);
 5671    }
 672
 673    private void AddEvent(
 674        GravitasDiagnosticEventKind kind,
 675        int bodyId = -1,
 676        int jointId = -1,
 677        int colliderAId = -1,
 678        int colliderBId = -1,
 679        GravitasColliderDimension colliderADimension = GravitasColliderDimension.None,
 680        GravitasColliderDimension colliderBDimension = GravitasColliderDimension.None,
 681        ColliderType colliderAType = ColliderType.None,
 682        ColliderType colliderBType = ColliderType.None,
 683        ColliderType2D colliderA2DType = ColliderType2D.None,
 684        ColliderType2D colliderB2DType = ColliderType2D.None,
 685        Vector3d start = default,
 686        Vector3d end = default,
 687        Vector3d pointA = default,
 688        Vector3d pointB = default,
 689        bool hasPointA = false,
 690        bool hasPointB = false,
 691        Vector3d vector = default,
 692        Fixed64 scalarA = default,
 693        Fixed64 scalarB = default,
 694        int dataA = 0,
 695        int dataB = 0,
 696        bool hit = false)
 697    {
 997698        _events.Add(new GravitasDiagnosticEvent(
 997699            _context.FrameCount,
 997700            _eventSequence++,
 997701            kind,
 997702            bodyId,
 997703            jointId,
 997704            colliderAId,
 997705            colliderBId,
 997706            ResolveDimension(colliderADimension, colliderAType),
 997707            ResolveDimension(colliderBDimension, colliderBType),
 997708            colliderAType,
 997709            colliderBType,
 997710            colliderA2DType,
 997711            colliderB2DType,
 997712            start,
 997713            end,
 997714            pointA,
 997715            pointB,
 997716            hasPointA,
 997717            hasPointB,
 997718            vector,
 997719            scalarA,
 997720            scalarB,
 997721            dataA,
 997722            dataB,
 997723            hit));
 997724    }
 725
 726    private void AddDrawCommand(
 727        GravitasDebugDrawKind kind,
 728        int colliderId = -1,
 729        ColliderType colliderType = ColliderType.None,
 730        GravitasColliderDimension colliderDimension = GravitasColliderDimension.None,
 731        ColliderType2D collider2DType = ColliderType2D.None,
 732        Vector3d start = default,
 733        Vector3d end = default,
 734        Vector3d center = default,
 735        Vector3d halfExtents = default,
 736        Vector3d pointA = default,
 737        Vector3d pointB = default,
 738        Vector3d pointC = default,
 739        FixedQuaternion rotation = default,
 740        Fixed64 radius = default,
 741        Fixed64 axisLength = default,
 742        Fixed64 height = default,
 743        GravitasDiagnosticColor color = default)
 744    {
 383745        _drawCommands.Add(new GravitasDebugDrawCommand(
 383746            _context.FrameCount,
 383747            _drawSequence++,
 383748            kind,
 383749            colliderId,
 383750            ResolveDimension(colliderDimension, colliderType),
 383751            colliderType,
 383752            collider2DType,
 383753            start,
 383754            end,
 383755            center,
 383756            halfExtents,
 383757            pointA,
 383758            pointB,
 383759            pointC,
 383760            rotation,
 383761            radius,
 383762            axisLength,
 383763            height,
 383764            color));
 383765    }
 766
 767    private static GravitasColliderDimension ResolveDimension(
 768        GravitasColliderDimension dimension,
 769        ColliderType colliderType)
 770    {
 2377771        if (dimension != GravitasColliderDimension.None)
 291772            return dimension;
 2086773        if (colliderType != ColliderType.None)
 1357774            return GravitasColliderDimension.ThreeD;
 729775        return GravitasColliderDimension.None;
 776    }
 777
 272778    private static Vector3d ToDiagnosticVector(Vector2d value) => new(value.X, Fixed64.Zero, value.Y);
 779}

/home/runner/work/Gravitas/Gravitas/src/Gravitas/Diagnostics/GravitasDiagnosticSink.Draw.cs

#LineLine coverage
 1//=======================================================================
 2// GravitasDiagnosticSink.Draw.cs
 3//=======================================================================
 4// MIT License, Copyright (c) 2026-present David Oravsky (mrdav30)
 5// See LICENSE file in the project root for full license information.
 6//=======================================================================
 7
 8using FixedMathSharp;
 9using FixedMathSharp.Geometry;
 10using Gravitas.Colliders;
 11using Gravitas.Constraints;
 12
 13namespace Gravitas.Diagnostics;
 14
 15/// <content>
 16/// Provides host-driven collider, joint, and primitive debug draw capture.
 17/// </content>
 18public sealed partial class GravitasDiagnosticSink
 19{
 20    /// <summary>
 21    /// Emits an engine-agnostic draw command for the supplied collider shape.
 22    /// </summary>
 23    public void CaptureCollider(LSCollider collider, GravitasDiagnosticColor color)
 24    {
 9825        if (!Enabled)
 8326            return;
 27
 1528        ChronicleGuard.ThrowIfNull(collider, nameof(collider));
 29        switch (collider)
 30        {
 31            case LSSphereCollider sphere:
 232                AddDrawCommand(
 233                    GravitasDebugDrawKind.WireSphere,
 234                    sphere.Id,
 235                    sphere.Shape,
 236                    center: sphere.Center,
 237                    radius: sphere.ScaledRadius,
 238                    color: color);
 239                break;
 40            case LSCapsuleCollider capsule:
 141                AddDrawCommand(
 142                    GravitasDebugDrawKind.WireCapsule,
 143                    capsule.Id,
 144                    capsule.Shape,
 145                    center: capsule.Center,
 146                    rotation: capsule.Rotation,
 147                    radius: capsule.ScaledRadius,
 148                    axisLength: capsule.AxisLength,
 149                    color: color);
 150                break;
 51            case LSCuboidCollider cuboid:
 152                AddDrawCommand(
 153                    GravitasDebugDrawKind.WireBox,
 154                    cuboid.Id,
 155                    cuboid.Shape,
 156                    center: cuboid.Center,
 157                    halfExtents: cuboid.OrientedBox.HalfExtents,
 158                    rotation: cuboid.Rotation,
 159                    color: color);
 160                break;
 61            case LSCylinderCollider cylinder:
 162                AddDrawCommand(
 163                    GravitasDebugDrawKind.WireCylinder,
 164                    cylinder.Id,
 165                    cylinder.Shape,
 166                    center: cylinder.Center,
 167                    rotation: cylinder.Rotation,
 168                    radius: cylinder.ScaledRadius,
 169                    height: cylinder.Height,
 170                    color: color);
 171                break;
 72            case LSConeCollider cone:
 173                AddDrawCommand(
 174                    GravitasDebugDrawKind.WireCone,
 175                    cone.Id,
 176                    cone.Shape,
 177                    center: cone.Center,
 178                    rotation: cone.Rotation,
 179                    radius: cone.ScaledRadius,
 180                    height: cone.Height,
 181                    color: color);
 182                break;
 83            case LSCompoundCollider compound:
 484                CaptureCompoundParts(compound, color);
 485                break;
 86            case LSMeshCollider mesh:
 387                CaptureMeshTriangles(mesh, color);
 88                break;
 89        }
 390    }
 91
 92    /// <summary>
 93    /// Emits engine-agnostic draw commands for the finite 2D slab used by mixed 2D/3D collision.
 94    /// </summary>
 95    public void CaptureMixedCollider(LSCollider2D collider, GravitasDiagnosticColor color)
 96    {
 1797        if (!Enabled)
 198            return;
 99
 16100        ChronicleGuard.ThrowIfNull(collider, nameof(collider));
 15101        Vector3d center = new(collider.Center.X, collider.MixedSlabCenterY, collider.Center.Y);
 15102        Fixed64 height = collider.MixedHalfThickness * 2;
 103        switch (collider)
 104        {
 105            case LSCircleCollider2D circle:
 1106                AddDrawCommand(
 1107                    GravitasDebugDrawKind.WireCylinder,
 1108                    circle.Id,
 1109                    colliderDimension: GravitasColliderDimension.TwoD,
 1110                    collider2DType: circle.Shape,
 1111                    center: center,
 1112                    radius: circle.ScaledRadius,
 1113                    height: height,
 1114                    color: color);
 1115                break;
 116            case LSCapsuleCollider2D capsule:
 5117                CaptureMixedCapsule(capsule, color, capsule.Id, capsule.Shape);
 5118                break;
 119            case LSAABBoxCollider2D box:
 1120                AddDrawCommand(
 1121                    GravitasDebugDrawKind.WireBox,
 1122                    box.Id,
 1123                    colliderDimension: GravitasColliderDimension.TwoD,
 1124                    collider2DType: box.Shape,
 1125                    center: center,
 1126                    halfExtents: new Vector3d(
 1127                        box.ScaledHalfExtents.X,
 1128                        collider.MixedHalfThickness,
 1129                        box.ScaledHalfExtents.Y),
 1130                    color: color);
 1131                break;
 132            case LSCompoundCollider2D compound:
 2133                CaptureMixedCompoundParts(compound, color);
 2134                break;
 135            default:
 6136                CaptureMixedPolygon(collider, color);
 137                break;
 138        }
 6139    }
 140
 141    /// <summary>
 142    /// Emits engine-agnostic draw commands for a 3D joint's anchors and active angular axes.
 143    /// </summary>
 144    public void CaptureJoint(Joint3D joint, GravitasDiagnosticColor color)
 145    {
 7146        if (!Enabled)
 1147            return;
 148
 6149        ChronicleGuard.ThrowIfNull(joint, nameof(joint));
 5150        SolidBody bodyA = joint.BodyA;
 5151        SolidBody bodyB = joint.BodyB;
 5152        FixedQuaternion rotationA = (bodyA.Rotation * joint.LocalFrameA.Rotation).Normalized;
 5153        FixedQuaternion rotationB = (bodyB.Rotation * joint.LocalFrameB.Rotation).Normalized;
 5154        Vector3d anchorA = bodyA.Position3d + bodyA.Rotation * joint.LocalFrameA.Position;
 5155        Vector3d anchorB = bodyB.Position3d + bodyB.Rotation * joint.LocalFrameB.Position;
 5156        Fixed64 pointRadius = Fixed64.One / (Fixed64)10;
 5157        Fixed64 axisLength = Fixed64.One;
 158
 5159        AddDrawCommand(
 5160            GravitasDebugDrawKind.Point,
 5161            bodyA.Collider.Id,
 5162            bodyA.Collider.Shape,
 5163            center: anchorA,
 5164            radius: pointRadius,
 5165            color: color);
 5166        AddDrawCommand(
 5167            GravitasDebugDrawKind.Point,
 5168            bodyB.Collider.Id,
 5169            bodyB.Collider.Shape,
 5170            center: anchorB,
 5171            radius: pointRadius,
 5172            color: color);
 5173        AddDrawCommand(
 5174            GravitasDebugDrawKind.Line,
 5175            bodyA.Collider.Id,
 5176            bodyA.Collider.Shape,
 5177            start: anchorA,
 5178            end: anchorB,
 5179            color: color);
 180
 5181        switch (joint.Type)
 182        {
 183            case JointType3D.Hinge:
 2184                CaptureJointAxis(anchorA, rotationA * Vector3d.Right, axisLength, bodyA.Collider, color);
 2185                CaptureJointAxis(anchorB, rotationB * Vector3d.Right, axisLength, bodyB.Collider, color);
 2186                break;
 187            case JointType3D.ConeTwist:
 1188                CaptureJointAxis(anchorA, rotationA * Vector3d.Forward, axisLength, bodyA.Collider, color);
 1189                CaptureJointAxis(anchorB, rotationB * Vector3d.Forward, axisLength, bodyB.Collider, color);
 1190                break;
 191            case JointType3D.Fixed:
 1192                CaptureJointAxis(anchorA, rotationA * Vector3d.Right, axisLength, bodyA.Collider, color);
 1193                CaptureJointAxis(anchorA, rotationA * Vector3d.Up, axisLength, bodyA.Collider, color);
 1194                CaptureJointAxis(anchorA, rotationA * Vector3d.Forward, axisLength, bodyA.Collider, color);
 195                break;
 196        }
 1197    }
 198
 199    /// <summary>
 200    /// Emits engine-agnostic draw commands for a pure 2D joint's anchors and active planar axis.
 201    /// </summary>
 202    public void CaptureJoint(Joint2D joint, GravitasDiagnosticColor color)
 203    {
 5204        if (!Enabled)
 1205            return;
 206
 4207        ChronicleGuard.ThrowIfNull(joint, nameof(joint));
 3208        SolidBody2D bodyA = joint.BodyA;
 3209        SolidBody2D bodyB = joint.BodyB;
 3210        Fixed64 y = bodyA.Agent.Transform.WorldPosition.Y;
 3211        Vector2d anchorA2D = bodyA.Position + Vector2d.Rotate(joint.LocalFrameA.Anchor, bodyA.Rotation);
 3212        Vector2d anchorB2D = bodyB.Position + Vector2d.Rotate(joint.LocalFrameB.Anchor, bodyB.Rotation);
 3213        Vector3d anchorA = new(anchorA2D.X, y, anchorA2D.Y);
 3214        Vector3d anchorB = new(anchorB2D.X, y, anchorB2D.Y);
 3215        Fixed64 pointRadius = Fixed64.One / (Fixed64)10;
 216
 3217        AddDrawCommand(
 3218            GravitasDebugDrawKind.Point,
 3219            bodyA.Collider.Id,
 3220            colliderDimension: GravitasColliderDimension.TwoD,
 3221            collider2DType: bodyA.Collider.Shape,
 3222            center: anchorA,
 3223            radius: pointRadius,
 3224            color: color);
 3225        AddDrawCommand(
 3226            GravitasDebugDrawKind.Point,
 3227            bodyB.Collider.Id,
 3228            colliderDimension: GravitasColliderDimension.TwoD,
 3229            collider2DType: bodyB.Collider.Shape,
 3230            center: anchorB,
 3231            radius: pointRadius,
 3232            color: color);
 3233        AddDrawCommand(
 3234            GravitasDebugDrawKind.Line,
 3235            bodyA.Collider.Id,
 3236            colliderDimension: GravitasColliderDimension.TwoD,
 3237            collider2DType: bodyA.Collider.Shape,
 3238            start: anchorA,
 3239            end: anchorB,
 3240            color: color);
 241
 3242        if (joint.Type != JointType2D.Prismatic)
 2243            return;
 244
 1245        Vector2d axis2D = Vector2d.Rotate(Vector2d.Right, bodyA.Rotation + joint.LocalFrameA.Angle);
 1246        Vector3d axis = new(axis2D.X, Fixed64.Zero, axis2D.Y);
 247
 1248        AddDrawCommand(
 1249            GravitasDebugDrawKind.Ray,
 1250            bodyA.Collider.Id,
 1251            colliderDimension: GravitasColliderDimension.TwoD,
 1252            collider2DType: bodyA.Collider.Shape,
 1253            start: anchorA,
 1254            end: anchorA + axis.Normalized,
 1255            color: color);
 1256    }
 257
 258    /// <summary>
 259    /// Emits an engine-agnostic line draw command.
 260    /// </summary>
 261    public void CaptureLine(Vector3d start, Vector3d end, GravitasDiagnosticColor color)
 262    {
 7263        if (!Enabled)
 1264            return;
 265
 6266        AddDrawCommand(
 6267            GravitasDebugDrawKind.Line,
 6268            start: start,
 6269            end: end,
 6270            color: color);
 6271    }
 272
 273    /// <summary>
 274    /// Emits an engine-agnostic ray draw command from an origin, direction, and length.
 275    /// </summary>
 276    public void CaptureRay(Vector3d origin, Vector3d direction, Fixed64 length, GravitasDiagnosticColor color)
 277    {
 3278        if (!Enabled)
 1279            return;
 280
 2281        Vector3d end = direction.MagnitudeSquared == Fixed64.Zero
 2282            ? origin
 2283            : origin + direction.Normalized * length;
 284
 2285        AddDrawCommand(
 2286            GravitasDebugDrawKind.Ray,
 2287            start: origin,
 2288            end: end,
 2289            color: color);
 2290    }
 291
 292    /// <summary>
 293    /// Emits an engine-agnostic point draw command.
 294    /// </summary>
 295    public void CapturePoint(Vector3d point, Fixed64 radius, GravitasDiagnosticColor color)
 296    {
 4297        if (!Enabled)
 1298            return;
 299
 3300        AddDrawCommand(
 3301            GravitasDebugDrawKind.Point,
 3302            center: point,
 3303            radius: radius,
 3304            color: color);
 3305    }
 306
 307    private void CaptureMeshTriangles(LSMeshCollider mesh, GravitasDiagnosticColor color)
 308    {
 3309        int triangleCount = mesh.Mesh.TriangleCount;
 522310        for (int i = 0; i < triangleCount; i++)
 311        {
 258312            if (!mesh.Mesh.TryGetTriangleVertices(
 258313                    i,
 258314                    out Vector3d first,
 258315                    out Vector3d second,
 258316                    out Vector3d third))
 317            {
 318                continue;
 319            }
 257320            AddDrawCommand(
 257321                GravitasDebugDrawKind.WireTriangle,
 257322                mesh.Id,
 257323                mesh.Shape,
 257324                pointA: first,
 257325                pointB: second,
 257326                pointC: third,
 257327                color: color);
 328        }
 3329    }
 330
 331    private void CaptureJointAxis(
 332        Vector3d anchor,
 333        Vector3d axis,
 334        Fixed64 length,
 335        LSCollider collider,
 336        GravitasDiagnosticColor color)
 337    {
 9338        AddDrawCommand(
 9339            GravitasDebugDrawKind.Ray,
 9340            collider.Id,
 9341            collider.Shape,
 9342            start: anchor,
 9343            end: anchor + axis.Normalized * length,
 9344            color: color);
 9345    }
 346
 347    private void CaptureCompoundParts(LSCompoundCollider compound, GravitasDiagnosticColor color)
 348    {
 24349        for (int i = 0; i < compound.PartCount; i++)
 350        {
 8351            LSCollider part = compound.GetPartCollider(i);
 352            switch (part)
 353            {
 354                case LSSphereCollider sphere:
 1355                    AddDrawCommand(
 1356                        GravitasDebugDrawKind.WireSphere,
 1357                        compound.Id,
 1358                        compound.Shape,
 1359                        center: sphere.Center,
 1360                        radius: sphere.ScaledRadius,
 1361                        color: color);
 1362                    break;
 363                case LSCapsuleCollider capsule:
 1364                    AddDrawCommand(
 1365                        GravitasDebugDrawKind.WireCapsule,
 1366                        compound.Id,
 1367                        compound.Shape,
 1368                        center: capsule.Center,
 1369                        rotation: capsule.Rotation,
 1370                        radius: capsule.ScaledRadius,
 1371                        axisLength: capsule.AxisLength,
 1372                        color: color);
 1373                    break;
 374                case LSCuboidCollider cuboid:
 1375                    AddDrawCommand(
 1376                        GravitasDebugDrawKind.WireBox,
 1377                        compound.Id,
 1378                        compound.Shape,
 1379                        center: cuboid.Center,
 1380                        halfExtents: cuboid.OrientedBox.HalfExtents,
 1381                        rotation: cuboid.Rotation,
 1382                        color: color);
 1383                    break;
 384                case LSCylinderCollider cylinder:
 1385                    AddDrawCommand(
 1386                        GravitasDebugDrawKind.WireCylinder,
 1387                        compound.Id,
 1388                        compound.Shape,
 1389                        center: cylinder.Center,
 1390                        rotation: cylinder.Rotation,
 1391                        radius: cylinder.ScaledRadius,
 1392                        height: cylinder.Height,
 1393                        color: color);
 1394                    break;
 395                case LSConeCollider cone:
 1396                    AddDrawCommand(
 1397                        GravitasDebugDrawKind.WireCone,
 1398                        compound.Id,
 1399                        compound.Shape,
 1400                        center: cone.Center,
 1401                        rotation: cone.Rotation,
 1402                        radius: cone.ScaledRadius,
 1403                        height: cone.Height,
 1404                        color: color);
 1405                    break;
 406                case LSMeshCollider mesh:
 3407                    CaptureCompoundMeshTriangles(compound, mesh, color);
 408                    break;
 409            }
 410        }
 4411    }
 412
 413    private void CaptureCompoundMeshTriangles(
 414        LSCompoundCollider compound,
 415        LSMeshCollider mesh,
 416        GravitasDiagnosticColor color)
 417    {
 3418        int triangleCount = mesh.Mesh.TriangleCount;
 34419        for (int i = 0; i < triangleCount; i++)
 420        {
 14421            if (!mesh.Mesh.TryGetTriangleVertices(
 14422                    i,
 14423                    out Vector3d first,
 14424                    out Vector3d second,
 14425                    out Vector3d third))
 426            {
 427                continue;
 428            }
 13429            AddDrawCommand(
 13430                GravitasDebugDrawKind.WireTriangle,
 13431                compound.Id,
 13432                compound.Shape,
 13433                pointA: first,
 13434                pointB: second,
 13435                pointC: third,
 13436                color: color);
 437        }
 3438    }
 439
 440    private void CaptureMixedCompoundParts(LSCompoundCollider2D compound, GravitasDiagnosticColor color)
 441    {
 12442        for (int i = 0; i < compound.PartCount; i++)
 443        {
 4444            LSCollider2D part = compound.GetPartCollider(i);
 4445            Vector3d center = new(part.Center.X, part.MixedSlabCenterY, part.Center.Y);
 4446            Fixed64 height = part.MixedHalfThickness * 2;
 447            switch (part)
 448            {
 449                case LSCircleCollider2D circle:
 1450                    AddDrawCommand(
 1451                        GravitasDebugDrawKind.WireCylinder,
 1452                        compound.Id,
 1453                        colliderDimension: GravitasColliderDimension.TwoD,
 1454                        collider2DType: compound.Shape,
 1455                        center: center,
 1456                        radius: circle.ScaledRadius,
 1457                        height: height,
 1458                        color: color);
 1459                    break;
 460                case LSCapsuleCollider2D capsule:
 1461                    CaptureMixedCapsule(capsule, color, compound.Id, compound.Shape);
 1462                    break;
 463                case LSAABBoxCollider2D box:
 1464                    AddDrawCommand(
 1465                        GravitasDebugDrawKind.WireBox,
 1466                        compound.Id,
 1467                        colliderDimension: GravitasColliderDimension.TwoD,
 1468                        collider2DType: compound.Shape,
 1469                        center: center,
 1470                        halfExtents: new Vector3d(
 1471                            box.ScaledHalfExtents.X,
 1472                            box.MixedHalfThickness,
 1473                            box.ScaledHalfExtents.Y),
 1474                        color: color);
 1475                    break;
 476                default:
 1477                    CaptureMixedPolygon(part, color, compound.Id, compound.Shape);
 478                    break;
 479            }
 480        }
 2481    }
 482
 483    private void CaptureMixedCapsule(
 484        LSCapsuleCollider2D capsule,
 485        GravitasDiagnosticColor color,
 486        int colliderId,
 487        ColliderType2D colliderType)
 488    {
 6489        bool hasFirstEndpoint = FixedSegment2d.TryGetCenteredAxisEndpoint(
 6490                capsule.Center,
 6491                capsule.WorldAxis,
 6492                capsule.AxisLength,
 6493                positive: false,
 6494                out Vector2d firstEndpoint);
 6495        bool hasSecondEndpoint = FixedSegment2d.TryGetCenteredAxisEndpoint(
 6496                capsule.Center,
 6497                capsule.WorldAxis,
 6498                capsule.AxisLength,
 6499                positive: true,
 6500                out Vector2d secondEndpoint);
 501
 6502        Fixed64 height = capsule.MixedHalfThickness * 2;
 6503        if (hasFirstEndpoint)
 504        {
 5505            AddDrawCommand(
 5506                GravitasDebugDrawKind.WireCylinder,
 5507                colliderId,
 5508                colliderDimension: GravitasColliderDimension.TwoD,
 5509                collider2DType: colliderType,
 5510                center: new Vector3d(firstEndpoint.X, capsule.MixedSlabCenterY, firstEndpoint.Y),
 5511                radius: capsule.ScaledRadius,
 5512                height: height,
 5513                color: color);
 514        }
 515
 6516        if (hasSecondEndpoint)
 517        {
 5518            AddDrawCommand(
 5519                GravitasDebugDrawKind.WireCylinder,
 5520                colliderId,
 5521                colliderDimension: GravitasColliderDimension.TwoD,
 5522                collider2DType: colliderType,
 5523                center: new Vector3d(secondEndpoint.X, capsule.MixedSlabCenterY, secondEndpoint.Y),
 5524                radius: capsule.ScaledRadius,
 5525                height: height,
 5526                color: color);
 527        }
 528
 6529        Fixed64 segmentLength = capsule.AxisLength;
 6530        if (segmentLength <= Fixed64.Epsilon || !hasFirstEndpoint || !hasSecondEndpoint)
 3531            return;
 532
 3533        AddDrawCommand(
 3534            GravitasDebugDrawKind.WireBox,
 3535            colliderId,
 3536            colliderDimension: GravitasColliderDimension.TwoD,
 3537            collider2DType: colliderType,
 3538            center: new Vector3d(capsule.Center.X, capsule.MixedSlabCenterY, capsule.Center.Y),
 3539            halfExtents: new Vector3d(
 3540                capsule.ScaledRadius,
 3541                capsule.MixedHalfThickness,
 3542                segmentLength / Fixed64.Two),
 3543            rotation: FixedQuaternion.FromEulerAngles(Fixed64.Zero, capsule.Rotation, Fixed64.Zero),
 3544            color: color);
 3545    }
 546
 547    private void CaptureMixedPolygon(LSCollider2D collider, GravitasDiagnosticColor color) =>
 6548        CaptureMixedPolygon(collider, color, collider.Id, collider.Shape);
 549
 550    private void CaptureMixedPolygon(
 551        LSCollider2D collider,
 552        GravitasDiagnosticColor color,
 553        int colliderId,
 554        ColliderType2D colliderType)
 555    {
 7556        int vertexCount = collider.VertexCount;
 7557        bool hasTop = Fixed64.TryAdd(
 7558            collider.MixedSlabCenterY,
 7559            collider.MixedHalfThickness,
 7560            out Fixed64 topY);
 7561        bool hasBottom = Fixed64.TrySubtract(
 7562            collider.MixedSlabCenterY,
 7563            collider.MixedHalfThickness,
 7564            out Fixed64 bottomY);
 62565        for (int i = 0; i < vertexCount; i++)
 566        {
 24567            if (!collider.TryGetVertex(i, out Vector2d current))
 568                continue;
 569
 20570            if (hasTop && hasBottom)
 571            {
 12572                AddDrawCommand(
 12573                    GravitasDebugDrawKind.Line,
 12574                    colliderId,
 12575                    colliderDimension: GravitasColliderDimension.TwoD,
 12576                    collider2DType: colliderType,
 12577                    start: new Vector3d(current.X, topY, current.Y),
 12578                    end: new Vector3d(current.X, bottomY, current.Y),
 12579                    color: color);
 580            }
 581
 20582            if (!collider.TryGetVertex(
 20583                    (i + 1) % vertexCount,
 20584                    out Vector2d next))
 585            {
 586                continue;
 587            }
 588
 18589            if (hasTop)
 590            {
 14591                AddDrawCommand(
 14592                    GravitasDebugDrawKind.Line,
 14593                    colliderId,
 14594                    colliderDimension: GravitasColliderDimension.TwoD,
 14595                    collider2DType: colliderType,
 14596                    start: new Vector3d(current.X, topY, current.Y),
 14597                    end: new Vector3d(next.X, topY, next.Y),
 14598                    color: color);
 599            }
 600
 18601            if (hasBottom)
 602            {
 14603                AddDrawCommand(
 14604                    GravitasDebugDrawKind.Line,
 14605                    colliderId,
 14606                    colliderDimension: GravitasColliderDimension.TwoD,
 14607                    collider2DType: colliderType,
 14608                    start: new Vector3d(current.X, bottomY, current.Y),
 14609                    end: new Vector3d(next.X, bottomY, next.Y),
 14610                    color: color);
 611            }
 612        }
 7613    }
 614
 615}

Methods/Properties

.ctor(Gravitas.GravitasWorldContext)
get_Events()
get_DrawCommands()
DispatchEventsTo(Gravitas.Diagnostics.GravitasDiagnosticEventVisitor)
DispatchDrawCommandsTo(Gravitas.Diagnostics.GravitasDebugDrawCommandVisitor)
get_EventCount()
get_DrawCommandCount()
get_EventCapacity()
get_DrawCommandCapacity()
Enable(System.Int32,System.Int32)
Disable()
Clear()
Reset()
EmitForceDelta(Gravitas.SolidBody,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d)
EmitTorqueDelta(Gravitas.SolidBody,FixedMathSharp.Vector3d)
EmitLinearVelocityDelta(Gravitas.SolidBody,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d)
EmitAngularVelocityDelta(Gravitas.SolidBody,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d)
EmitGroundProbe(Gravitas.SolidBody,Gravitas.GroundProbeMode,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,System.Boolean,Gravitas.Queries.Physics3DHit)
EmitGroundProbe(Gravitas.SolidBody2D,Gravitas.GroundProbeMode2D,FixedMathSharp.Vector2d,FixedMathSharp.Vector2d,FixedMathSharp.Fixed64,System.Boolean,Gravitas.Queries.Physics2DHit)
EmitRayQuery(FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,System.Int32,System.Boolean,System.Int32,Gravitas.Queries.Physics3DHit)
EmitCircleQuery(FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,System.Int32,System.Boolean,System.Int32,Gravitas.Queries.Physics3DHit)
EmitQuerySummary(Gravitas.Diagnostics.GravitasColliderDimension,Gravitas.Diagnostics.GravitasColliderDimension,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,System.Int32,System.Int32,System.Int32,System.Int32)
EmitContact(Gravitas.CollisionHandling.CollisionPair,System.Boolean)
EmitResponseImpulse(Gravitas.CollisionHandling.CollisionPair,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,System.Nullable`1<Gravitas.CollisionHandling.ManifoldContact>)
EmitMixedQuery(FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,System.Int32,System.Boolean,System.Int32,Gravitas.Queries.PhysicsMixedHit)
EmitMixedContact(Gravitas.CollisionHandling.CollisionPairMixed,Gravitas.CollisionHandling.MixedContact)
EmitMixedResponseImpulse(Gravitas.CollisionHandling.CollisionPairMixed,Gravitas.CollisionHandling.MixedContact,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,System.Int32,System.Int32)
EmitMixedResponseIsland(System.Int32,System.Int32,System.Int32,System.Boolean)
EmitJointRegistered(Gravitas.Constraints.Joint3D)
EmitJointRegistered(Gravitas.Constraints.Joint2D)
EmitJointRemoved(Gravitas.Constraints.Joint3D)
EmitJointRemoved(Gravitas.Constraints.Joint2D)
EmitJointImpulse(Gravitas.Constraints.Joint3D,Gravitas.Constraints.JointSolveMetrics3D)
EmitJointImpulse(Gravitas.Constraints.Joint2D,Gravitas.Constraints.JointSolveMetrics2D)
EmitJointLimitReached(Gravitas.Constraints.Joint3D,FixedMathSharp.Fixed64)
EmitJointLimitReached(Gravitas.Constraints.Joint2D,FixedMathSharp.Fixed64)
EmitRagdollActivated(System.Int32,System.Int32,System.Int32,System.Boolean)
AddEvent(Gravitas.Diagnostics.GravitasDiagnosticEventKind,System.Int32,System.Int32,System.Int32,System.Int32,Gravitas.Diagnostics.GravitasColliderDimension,Gravitas.Diagnostics.GravitasColliderDimension,Gravitas.Colliders.ColliderType,Gravitas.Colliders.ColliderType,Gravitas.Colliders.ColliderType2D,Gravitas.Colliders.ColliderType2D,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,System.Boolean,System.Boolean,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,FixedMathSharp.Fixed64,System.Int32,System.Int32,System.Boolean)
AddDrawCommand(Gravitas.Diagnostics.GravitasDebugDrawKind,System.Int32,Gravitas.Colliders.ColliderType,Gravitas.Diagnostics.GravitasColliderDimension,Gravitas.Colliders.ColliderType2D,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.FixedQuaternion,FixedMathSharp.Fixed64,FixedMathSharp.Fixed64,FixedMathSharp.Fixed64,Gravitas.Diagnostics.GravitasDiagnosticColor)
ResolveDimension(Gravitas.Diagnostics.GravitasColliderDimension,Gravitas.Colliders.ColliderType)
ToDiagnosticVector(FixedMathSharp.Vector2d)
CaptureCollider(Gravitas.Colliders.LSCollider,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureMixedCollider(Gravitas.Colliders.LSCollider2D,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureJoint(Gravitas.Constraints.Joint3D,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureJoint(Gravitas.Constraints.Joint2D,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureLine(FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureRay(FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,Gravitas.Diagnostics.GravitasDiagnosticColor)
CapturePoint(FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureMeshTriangles(Gravitas.Colliders.LSMeshCollider,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureJointAxis(FixedMathSharp.Vector3d,FixedMathSharp.Vector3d,FixedMathSharp.Fixed64,Gravitas.Colliders.LSCollider,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureCompoundParts(Gravitas.Colliders.LSCompoundCollider,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureCompoundMeshTriangles(Gravitas.Colliders.LSCompoundCollider,Gravitas.Colliders.LSMeshCollider,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureMixedCompoundParts(Gravitas.Colliders.LSCompoundCollider2D,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureMixedCapsule(Gravitas.Colliders.LSCapsuleCollider2D,Gravitas.Diagnostics.GravitasDiagnosticColor,System.Int32,Gravitas.Colliders.ColliderType2D)
CaptureMixedPolygon(Gravitas.Colliders.LSCollider2D,Gravitas.Diagnostics.GravitasDiagnosticColor)
CaptureMixedPolygon(Gravitas.Colliders.LSCollider2D,Gravitas.Diagnostics.GravitasDiagnosticColor,System.Int32,Gravitas.Colliders.ColliderType2D)