Engine-Pong/Game/Physics2D/PhysicsEngine2D.cs

89 lines
2.6 KiB
C#
Raw Normal View History

2023-11-30 17:52:09 +03:00
using System;
using System.Collections.Generic;
using Microsoft.Xna.Framework;
using Syntriax.Engine.Core.Abstract;
using Syntriax.Engine.Physics2D.Abstract;
namespace Syntriax.Engine.Physics2D;
public class PhysicsEngine2D : IPhysicsEngine2D
{
private IList<IRigidBody2D> rigidBodies = new List<IRigidBody2D>(32);
private IList<ICollider2D> colliders = new List<ICollider2D>(64);
private int _iterationCount = 1;
public int IterationCount { get => _iterationCount; set => _iterationCount = value < 1 ? 1 : value; }
public void AddRigidBody(IRigidBody2D rigidBody)
{
if (rigidBodies.Contains(rigidBody))
return;
rigidBodies.Add(rigidBody);
foreach (var collider2D in rigidBody.BehaviourController.GetBehaviours<ICollider2D>())
colliders.Add(collider2D);
rigidBody.BehaviourController.OnBehaviourAdded += OnBehaviourAdded;
rigidBody.BehaviourController.OnBehaviourRemoved += OnBehaviourRemoved;
}
public void RemoveRigidBody(IRigidBody2D rigidBody)
{
rigidBodies.Remove(rigidBody);
}
public void Step(float deltaTime)
{
float intervalDeltaTime = deltaTime / IterationCount;
for (int i = 0; i < IterationCount; i++)
{
foreach (var rigidBody in rigidBodies)
{
Vector2 nextPosition = rigidBody.Transform.Position;
nextPosition += rigidBody.Velocity * intervalDeltaTime;
2023-12-01 17:42:07 +03:00
rigidBody.Transform.Position = nextPosition;
2023-11-30 17:52:09 +03:00
}
2023-12-01 17:42:07 +03:00
foreach (var collider in colliders)
collider.RecalculateVertices();
2023-11-30 17:52:09 +03:00
for (int colliderIX = 0; colliderIX < colliders.Count; colliderIX++)
{
ICollider2D colliderX = colliders[colliderIX];
for (int colliderIY = colliderIX + 1; colliderIY < colliders.Count; colliderIY++)
2023-12-01 17:42:07 +03:00
foreach (var vertex in colliderX.Vertices)
{
if (!colliders[colliderIY].CheckCollision(vertex, colliderX))
continue;
2023-11-30 17:52:09 +03:00
Console.WriteLine($"Collision");
2023-12-01 17:42:07 +03:00
break;
}
2023-11-30 17:52:09 +03:00
}
}
}
private void OnBehaviourAdded(IBehaviourController controller, IBehaviour behaviour)
{
if (behaviour is not ICollider2D collider2D)
return;
colliders.Add(collider2D);
}
private void OnBehaviourRemoved(IBehaviourController controller, IBehaviour behaviour)
{
if (behaviour is not ICollider2D collider2D)
return;
colliders.Remove(collider2D);
}
}