mirror of
https://github.com/AlexMacocian/MonoGame.Extended.git
synced 2026-07-26 00:45:20 +00:00
Zoey MandDylan Wilson
2b269d563b
- The equality check is a little gross for dynamicBody -> otherDynamicBody, but it works for now. - Added notes about how I did this. - Tested it with the current platformer demo
81 lines
2.9 KiB
C#
81 lines
2.9 KiB
C#
using System;
|
|
using System.Collections.Generic;
|
|
using Microsoft.Xna.Framework;
|
|
|
|
namespace Platformer.Collisions
|
|
{
|
|
public class World
|
|
{
|
|
public World(Vector2 gravity)
|
|
{
|
|
Gravity = gravity;
|
|
}
|
|
|
|
public Vector2 Gravity { get; set; }
|
|
|
|
private readonly List<Body> _dynamicBodies = new List<Body>();
|
|
private readonly List<Body> _staticBodies = new List<Body>();
|
|
|
|
public void AddBody(Body body)
|
|
{
|
|
if (body.BodyType == BodyType.Dynamic)
|
|
_dynamicBodies.Add(body);
|
|
else
|
|
_staticBodies.Add(body);
|
|
}
|
|
|
|
public void RemoveBody(Body body)
|
|
{
|
|
if (body.BodyType == BodyType.Dynamic)
|
|
_dynamicBodies.Remove(body);
|
|
else
|
|
_staticBodies.Remove(body);
|
|
}
|
|
|
|
public void Update(float deltaTime)
|
|
{
|
|
// apply gravity (and other forces?)
|
|
foreach (var body in _dynamicBodies)
|
|
body.Velocity += Gravity;
|
|
|
|
foreach (var dynamicBody in _dynamicBodies)
|
|
{
|
|
dynamicBody.Position.X += dynamicBody.Velocity.X * deltaTime;
|
|
ResolveCollisions(dynamicBody);
|
|
|
|
dynamicBody.Position.Y += dynamicBody.Velocity.Y * deltaTime;
|
|
ResolveCollisions(dynamicBody);
|
|
}
|
|
}
|
|
|
|
private void ResolveCollisions(Body dynamicBody)
|
|
{
|
|
foreach (var staticBody in _staticBodies)
|
|
{
|
|
var vector = staticBody.Position - dynamicBody.Position;
|
|
|
|
if (CollisionTester.AabbAabb(dynamicBody.BoundingBox, staticBody.BoundingBox, vector, out var manifold))
|
|
{
|
|
dynamicBody.Position -= manifold.Normal * manifold.Penetration;
|
|
dynamicBody.Velocity = dynamicBody.Velocity * new Vector2(Math.Abs(manifold.Normal.Y), Math.Abs(manifold.Normal.X));
|
|
}
|
|
}
|
|
|
|
foreach (var otherDynamicBody in _dynamicBodies)
|
|
{
|
|
if (dynamicBody != otherDynamicBody) //TODO: Equality should be implemented better than this
|
|
{
|
|
var vector = otherDynamicBody.Position - dynamicBody.Position;
|
|
|
|
if (CollisionTester.AabbAabb(dynamicBody.BoundingBox, otherDynamicBody.BoundingBox, vector, out var manifold))
|
|
{
|
|
//Invert how the manifold is applied from how this is done with static bodyies.
|
|
//This will create the effect that the dynamic body in motion is pushing the other dynamic body.
|
|
otherDynamicBody.Position += manifold.Normal * manifold.Penetration;
|
|
otherDynamicBody.Velocity = otherDynamicBody.Velocity * new Vector2(System.Math.Abs(manifold.Normal.Y), System.Math.Abs(manifold.Normal.X));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
} |