/// <summary>
/// Easily makes a Compound shape for you, given a list of individual shapes and how they should be offset.
/// </summary>
/// <param name="shapes">List of convex shapes</param>
/// <param name="offsets">Matching length list of offsets of bodies, can be null if nothing has an offset</param>
/// <param name="rotations">Matching length list of rotations of bodies, can be null if nothing is rotated</param>
/// <param name="isDynamic">True if intended to use in a dynamic situation, false if kinematic or static</param>
/// <returns></returns>
public static ICompoundShape MakeCompound(List <IConvexShape> shapes, List <Vector3> offsets = null, List <Quaternion> rotations = null, bool isDynamic = true, int bigThreshold = 5)
{
using (var compoundBuilder = new CompoundBuilder(BepuSimulation.safeBufferPool, BepuSimulation.instance.internalSimulation.Shapes, shapes.Count))
{
bool allConvex = true;
//All allocations from the buffer pool used for the final compound shape will be disposed when the demo is disposed. Don't have to worry about leaks in these demos.
for (int i = 0; i < shapes.Count; i++)
{
if (shapes[i] is ICompoundShape)
{
throw new InvalidOperationException("Cannot include compounds in another compound shape.");
}
if (isDynamic)
{
compoundBuilder.AddEasy(shapes[i] as IConvexShape, new BepuPhysics.RigidPose(ToBepu(offsets?[i] ?? Vector3.Zero), ToBepu(rotations?[i] ?? Quaternion.Identity)), 1f);
}
else
{
if (shapes[i] is IConvexShape == false)
{
allConvex = false;
}
compoundBuilder.AddForKinematicEasy(shapes[i], new BepuPhysics.RigidPose(ToBepu(offsets?[i] ?? Vector3.Zero), ToBepu(rotations?[i] ?? Quaternion.Identity)), 1f);
}
}
return(compoundBuilder.BuildCompleteCompoundShape(BepuSimulation.instance.internalSimulation.Shapes, BepuSimulation.safeBufferPool, isDynamic, allConvex ? bigThreshold : int.MaxValue));
}
}
public static IShape OffsetSingleShape(IConvexShape shape, Vector3?offset = null, Quaternion?rotation = null, bool kinematic = false)
{
if (offset.HasValue == false && rotation.HasValue == false)
{
return(shape);
}
if (shape is ICompoundShape)
{
throw new InvalidOperationException("Cannot offset a compound shape. Can't support nested compounds.");
}
using (var compoundBuilder = new CompoundBuilder(BepuSimulation.safeBufferPool, BepuSimulation.instance.internalSimulation.Shapes, 1))
{
using (BepuSimulation.instance.simulationLocker.WriteLock())
{
if (kinematic)
{
compoundBuilder.AddForKinematicEasy(shape, new BepuPhysics.RigidPose(ToBepu(offset ?? Vector3.Zero), ToBepu(rotation ?? Quaternion.Identity)), 1f);
}
else
{
compoundBuilder.AddEasy(shape, new BepuPhysics.RigidPose(ToBepu(offset ?? Vector3.Zero), ToBepu(rotation ?? Quaternion.Identity)), 1f);
}
return(compoundBuilder.BuildCompleteCompoundShape(BepuSimulation.instance.internalSimulation.Shapes, BepuSimulation.safeBufferPool, kinematic));
}
}
}
public unsafe override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(0, 9, -40);
camera.Yaw = MathHelper.Pi;
camera.Pitch = 0;
var filters = new BodyProperty <SubgroupCollisionFilter>();
Simulation = Simulation.Create(BufferPool, new SubgroupFilteredCallbacks {
CollisionFilters = filters
}, new DemoPoseIntegratorCallbacks(new Vector3(0, -10, 0)));
int ragdollIndex = 0;
var spacing = new Vector3(1.7f, 1.8f, 0.5f);
int width = 4;
int height = 4;
int length = 44;
var origin = -0.5f * spacing * new Vector3(width - 1, 0, length - 1) + new Vector3(0, 5f, 0);
for (int i = 0; i < width; ++i)
{
for (int j = 0; j < height; ++j)
{
for (int k = 0; k < length; ++k)
{
RagdollDemo.AddRagdoll(origin + spacing * new Vector3(i, j, k), Quaternion.CreateFromAxisAngle(new Vector3(0, 1, 0), MathHelper.Pi * 0.05f), ragdollIndex++, filters, Simulation);
}
}
}
var tubeCenter = new Vector3(0, 8, 0);
const int panelCount = 20;
const float tubeRadius = 6;
var panelShape = new Box((float)Math.PI * 2 * tubeRadius / panelCount, 1, 80);
var panelShapeIndex = Simulation.Shapes.Add(panelShape);
var builder = new CompoundBuilder(BufferPool, Simulation.Shapes, panelCount + 1);
for (int i = 0; i < panelCount; ++i)
{
var rotation = Quaternion.CreateFromAxisAngle(Vector3.UnitZ, i * MathHelper.TwoPi / panelCount);
Quaternion.TransformUnitY(rotation, out var localUp);
var position = localUp * tubeRadius;
builder.AddForKinematic(panelShapeIndex, new RigidPose(position, rotation), 1);
}
builder.AddForKinematic(Simulation.Shapes.Add(new Box(1, 2, panelShape.Length)), new RigidPose(new Vector3(0, tubeRadius - 1, 0)), 0);
builder.BuildKinematicCompound(out var children);
var compound = new BigCompound(children, Simulation.Shapes, BufferPool);
Simulation.Bodies.Add(BodyDescription.CreateKinematic(tubeCenter, new BodyVelocity(default, new Vector3(0, 0, .25f)), new CollidableDescription(Simulation.Shapes.Add(compound), 0.1f), new BodyActivityDescription()));
public override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(0, 4, -6);
camera.Yaw = MathHelper.Pi;
Simulation = Simulation.Create(BufferPool, new IndexReportingNarrowPhaseCallbacks(), new DemoPoseIntegratorCallbacks(new Vector3(0, 0f, 0)));
var builder = new CompoundBuilder(BufferPool, Simulation.Shapes, 4);
builder.Add(new Sphere(0.5f), new RigidPose(new Vector3(-1, 0, 0)), 1);
builder.Add(new Capsule(0.5f, 1f), new RigidPose(new Vector3(0, 0, 0)), 1);
builder.Add(new Box(1f, 1f, 1f), new RigidPose(new Vector3(1, 0, 0)), 1);
builder.BuildDynamicCompound(out var children, out var inertia, out var center);
var compoundCollidable = new CollidableDescription(Simulation.Shapes.Add(new Compound(children)), 0.1f);
Simulation.Bodies.Add(BodyDescription.CreateDynamic(new Vector3(0, 2, 0), inertia, compoundCollidable, new BodyActivityDescription(0.01f)));
Simulation.Bodies.Add(BodyDescription.CreateDynamic(new Vector3(0, 4, 0), inertia, compoundCollidable, new BodyActivityDescription(0.01f)));
Simulation.Statics.Add(new StaticDescription(new Vector3(), new CollidableDescription(Simulation.Shapes.Add(new Box(100, 1, 100)), 0.1f)));
}
public override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(0, 8, -10);
camera.Yaw = MathHelper.Pi;
Simulation = Simulation.Create(BufferPool, new DemoNarrowPhaseCallbacks(), new DemoPoseIntegratorCallbacks(new Vector3(0, -10, 0)), new PositionFirstTimestepper());
DemoMeshHelper.LoadModel(content, BufferPool, @"Content\newt.obj", Vector3.One, out var mesh);
new Box(2.5f, 1, 4).ComputeInertia(1, out var approximateInertia);
var meshShapeIndex = Simulation.Shapes.Add(mesh);
for (int meshIndex = 0; meshIndex < 3; ++meshIndex)
{
Simulation.Bodies.Add(
BodyDescription.CreateDynamic(new Vector3(0, 2 + meshIndex * 2, 0), approximateInertia,
new CollidableDescription(meshShapeIndex, 0.1f), new BodyActivityDescription(0.01f)));
}
var compoundBuilder = new CompoundBuilder(BufferPool, Simulation.Shapes, 12);
for (int i = 0; i < mesh.Triangles.Length; ++i)
{
compoundBuilder.Add(mesh.Triangles[i], RigidPose.Identity, 1);
}
compoundBuilder.BuildDynamicCompound(out var children, out var compoundInertia);
var compound = new BigCompound(children, Simulation.Shapes, BufferPool);
var compoundShapeIndex = Simulation.Shapes.Add(compound);
compoundBuilder.Dispose();
for (int i = 0; i < 3; ++i)
{
Simulation.Bodies.Add(BodyDescription.CreateDynamic(new Vector3(5, 2 + i * 2, 0), compoundInertia, new CollidableDescription(compoundShapeIndex, 0.1f), new BodyActivityDescription(0.01f)));
}
var staticShape = new Box(1500, 1, 1500);
var staticShapeIndex = Simulation.Shapes.Add(staticShape);
Simulation.Statics.Add(new StaticDescription(new Vector3(0, -0.5f, 0), new CollidableDescription(staticShapeIndex, 0.1f)));
}
public unsafe override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(-13f, 6, -13f);
camera.Yaw = MathHelper.Pi * 3f / 4;
camera.Pitch = MathHelper.Pi * 0.05f;
Simulation = Simulation.Create(BufferPool, new DemoNarrowPhaseCallbacks(), new DemoPoseIntegratorCallbacks(new Vector3(0, -10f, 0)));
using (var compoundBuilder = new CompoundBuilder(BufferPool, Simulation.Shapes, 8))
{
{
//Note that, in bepuphysics v2, there is no 'recentering' when constructing a shape. The pose you pass in for a child is exactly the pose that the compound will use,
//even if the 'true' center of mass isn't at the local origin.
//Instead, if recentering is desired, it should performed ahead of time. The CompoundBuilder can help with this.
//We'll construct this compound using shapes far from the origin, and then use the CompoundBuilder overload that recenters the children and outputs the computed center.
var capsuleChildShape = new Capsule(0.5f, 0.5f);
var capsuleLocalPose = new RigidPose {
Position = new Vector3(-0.5f, 4, 4), Orientation = Quaternion.Identity
};
var boxChildShape = new Box(0.5f, 1f, 1.5f);
var boxLocalPose = new RigidPose {
Position = new Vector3(0.5f, 4, 4), Orientation = Quaternion.Identity
};
//All allocations from the buffer pool used for the final compound shape will be disposed when the demo is disposed. Don't have to worry about leaks in these demos.
compoundBuilder.Add(capsuleChildShape, capsuleLocalPose, 1);
compoundBuilder.Add(boxChildShape, boxLocalPose, 1);
compoundBuilder.BuildDynamicCompound(out var compoundChildren, out var compoundInertia, out var compoundCenter);
compoundBuilder.Reset();
var compound = new Compound(compoundChildren);
var compoundDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(compound),
SpeculativeMargin = 0.1f,
},
LocalInertia = compoundInertia,
Pose = new RigidPose {
Position = compoundCenter, Orientation = Quaternion.Identity
},
};
Simulation.Bodies.Add(compoundDescription);
}
//Build a stack of sphere grids to stress manifold reduction heuristics in a convex-ish situation.
{
var gridShape = new Sphere(0.5f);
const float gridSpacing = 1.5f;
const int gridWidth = 3;
var gridShapeIndex = Simulation.Shapes.Add(gridShape);
gridShape.ComputeInertia(1, out var gridBoxInertia);
float localPoseOffset = -0.5f * gridSpacing * (gridWidth - 1);
for (int i = 0; i < gridWidth; ++i)
{
for (int j = 0; j < gridWidth; ++j)
{
var localPose = new RigidPose
{
Orientation = Quaternion.Identity,
Position = new Vector3(localPoseOffset, 0, localPoseOffset) + new Vector3(gridSpacing) * new Vector3(i, 0, j)
};
compoundBuilder.Add(gridShapeIndex, localPose, gridBoxInertia.InverseInertiaTensor, 1);
}
}
compoundBuilder.BuildDynamicCompound(out var gridChildren, out var gridInertia, out var center);
compoundBuilder.Reset();
var gridCompound = new Compound(gridChildren);
var bodyDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(gridCompound),
SpeculativeMargin = 0.1f,
},
LocalInertia = gridInertia,
Pose = new RigidPose {
Orientation = Quaternion.Identity
}
};
for (int i = 0; i < 4; ++i)
{
bodyDescription.Pose.Position = new Vector3(0, 2 + i * 3, 0);
//if (i == 0)
// gridDescription.LocalInertia = new BodyInertia();
//else
// gridDescription.LocalInertia = gridInertia;
Simulation.Bodies.Add(bodyDescription);
}
}
//Build a table and use it for a couple of different tests.
{
var legShape = new Box(0.2f, 1, 0.2f);
legShape.ComputeInertia(1f, out var legInverseInertia);
var legShapeIndex = Simulation.Shapes.Add(legShape);
var legPose0 = new RigidPose {
Position = new Vector3(-1.5f, 0, -1.5f), Orientation = Quaternion.Identity
};
var legPose1 = new RigidPose {
Position = new Vector3(-1.5f, 0, 1.5f), Orientation = Quaternion.Identity
};
var legPose2 = new RigidPose {
Position = new Vector3(1.5f, 0, -1.5f), Orientation = Quaternion.Identity
};
var legPose3 = new RigidPose {
Position = new Vector3(1.5f, 0, 1.5f), Orientation = Quaternion.Identity
};
compoundBuilder.Add(legShapeIndex, legPose0, legInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(legShapeIndex, legPose1, legInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(legShapeIndex, legPose2, legInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(legShapeIndex, legPose3, legInverseInertia.InverseInertiaTensor, 1);
var tableTopPose = new RigidPose {
Position = new Vector3(0, 0.6f, 0), Orientation = Quaternion.Identity
};
var tableTopShape = new Box(3.2f, 0.2f, 3.2f);
compoundBuilder.Add(tableTopShape, tableTopPose, 3);
compoundBuilder.BuildDynamicCompound(out var tableChildren, out var tableInertia, out var tableCenter);
compoundBuilder.Reset();
var table = new Compound(tableChildren);
var tableDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(table),
SpeculativeMargin = 0.1f,
},
LocalInertia = tableInertia,
Pose = new RigidPose {
Orientation = Quaternion.Identity
}
};
//Stack some tables.
{
for (int i = 0; i < 10; ++i)
{
tableDescription.Pose.Position = new Vector3(10, 3 + i * 1.4f, 10);
Simulation.Bodies.Add(tableDescription);
}
}
{
for (int k = 0; k < 5; ++k)
{
tableDescription.Pose.Position = new Vector3(64 + k * 3, 6 + k * 1.4f, 32);
Simulation.Bodies.Add(tableDescription);
}
//for (int i = 0; i < 10; ++i)
//{
// for (int j = 0; j < 20; ++j)
// {
// for (int k = 0; k < 10; ++k)
// {
// tableDescription.Pose.Position = new Vector3(32 + i * 6, 6 + j * 1.4f, 16 + k * 6);
// Simulation.Bodies.Add(tableDescription);
// }
// }
//}
}
//Put a table on top of a sphere to stress out nonconvex reduction for divergent normals.
{
tableDescription.Pose.Position = new Vector3(10, 6, 0);
Simulation.Bodies.Add(tableDescription);
var sphereShape = new Sphere(3);
var sphereIndex = Simulation.Shapes.Add(sphereShape);
var sphereDescription = new StaticDescription
{
Collidable = new CollidableDescription
{
Shape = sphereIndex,
SpeculativeMargin = 0.1f,
},
Pose = new RigidPose {
Position = new Vector3(10, 2, 0), Orientation = Quaternion.Identity
}
};
Simulation.Statics.Add(sphereDescription);
}
//Put another table on the ground, but with a clamp-ish thing on it that generates opposing normals.
{
tableDescription.Pose.Position = new Vector3(10, 3, -10);
Simulation.Bodies.Add(tableDescription);
var clampPieceShape = new Box(2f, 0.1f, 0.3f);
clampPieceShape.ComputeInertia(1f, out var clampPieceInverseInertia);
var clampPieceShapeIndex = Simulation.Shapes.Add(clampPieceShape);
var clamp0 = new RigidPose {
Position = new Vector3(0, -0.2f, -1.1f), Orientation = Quaternion.Identity
};
var clamp1 = new RigidPose {
Position = new Vector3(0, 0.2f, -1.1f), Orientation = Quaternion.Identity
};
var clamp2 = new RigidPose {
Position = new Vector3(0, -0.2f, 0), Orientation = Quaternion.Identity
};
var clamp3 = new RigidPose {
Position = new Vector3(0, 0.2f, 0), Orientation = Quaternion.Identity
};
var clamp4 = new RigidPose {
Position = new Vector3(0, -0.2f, 1.1f), Orientation = Quaternion.Identity
};
var clamp5 = new RigidPose {
Position = new Vector3(0, 0.2f, 1.1f), Orientation = Quaternion.Identity
};
compoundBuilder.Add(clampPieceShapeIndex, clamp0, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp1, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp2, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp3, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp4, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp5, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.BuildDynamicCompound(out var clampChildren, out var clampInertia, out var clampCenter);
compoundBuilder.Reset();
var clamp = new Compound(clampChildren);
var clampDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(clamp),
SpeculativeMargin = 0.1f,
},
LocalInertia = clampInertia,
Pose = new RigidPose {
Position = tableDescription.Pose.Position + new Vector3(2f, 0.3f, 0), Orientation = Quaternion.Identity
}
};
Simulation.Bodies.Add(clampDescription);
}
}
//Create a tree-accelerated big compound.
{
var random = new Random(5);
var treeCompoundBoxShape = new Box(0.5f, 1.5f, 1f);
var treeCompoundBoxShapeIndex = Simulation.Shapes.Add(treeCompoundBoxShape);
treeCompoundBoxShape.ComputeInertia(1, out var childInertia);
for (int i = 0; i < 128; ++i)
{
RigidPose localPose;
localPose.Position = new Vector3(12, 6, 12) * (0.5f * new Vector3((float)random.NextDouble(), (float)random.NextDouble(), (float)random.NextDouble()) - Vector3.One);
float orientationLengthSquared;
do
{
localPose.Orientation = new Quaternion((float)random.NextDouble(), (float)random.NextDouble(), (float)random.NextDouble(), (float)random.NextDouble());
orientationLengthSquared = QuaternionEx.LengthSquared(ref localPose.Orientation);
}while (orientationLengthSquared < 1e-9f);
QuaternionEx.Scale(localPose.Orientation, 1f / MathF.Sqrt(orientationLengthSquared), out localPose.Orientation);
//Quaternion.CreateFromAxisAngle(new Vector3(1, 0, 0), MathF.PI, out localPose.Orientation);
compoundBuilder.Add(treeCompoundBoxShapeIndex, localPose, childInertia.InverseInertiaTensor, 1);
}
compoundBuilder.BuildDynamicCompound(out var children, out var inertia, out var center);
compoundBuilder.Reset();
var compound = new BigCompound(children, Simulation.Shapes, BufferPool);
//var compound = new Compound(children);
var compoundIndex = Simulation.Shapes.Add(compound);
for (int i = 0; i < 8; ++i)
{
Simulation.Bodies.Add(BodyDescription.CreateDynamic(new Vector3(0, 4 + 5 * i, 32), inertia, new CollidableDescription(compoundIndex, 0.1f), new BodyActivityDescription(0.01f)));
}
}
}
//Prevent stuff from falling into the infinite void.
{
var boxShape = new Box(256, 1, 256);
var groundShapeIndex = Simulation.Shapes.Add(boxShape);
var groundDescription = new StaticDescription
{
Collidable = new CollidableDescription
{
Shape = groundShapeIndex,
SpeculativeMargin = 0.1f,
},
Pose = new RigidPose {
Position = new Vector3(0, 0, 0), Orientation = Quaternion.Identity
}
};
Simulation.Statics.Add(groundDescription);
}
const int planeWidth = 48;
const int planeHeight = 48;
DemoMeshHelper.CreateDeformedPlane(planeWidth, planeHeight,
(int x, int y) =>
{
Vector2 offsetFromCenter = new Vector2(x - planeWidth / 2, y - planeHeight / 2);
return(new Vector3(offsetFromCenter.X, MathF.Cos(x / 4f) * MathF.Sin(y / 4f) - 0.01f * offsetFromCenter.LengthSquared(), offsetFromCenter.Y));
}, new Vector3(2, 1, 2), BufferPool, out var planeMesh);
Simulation.Statics.Add(new StaticDescription(new Vector3(64, 4, 32), QuaternionEx.CreateFromAxisAngle(new Vector3(0, 1, 0), MathF.PI / 2),
new CollidableDescription(Simulation.Shapes.Add(planeMesh), 0.1f)));
}
public override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(0, 5, 10);
camera.Yaw = 0;
camera.Pitch = 0;
bodyProperties = new CollidableProperty <TankDemoBodyProperties>();
//We assign velocities outside of the timestep to fire bullets, so using the PositionLastTimestepper avoids integrating those velocities into positions before the solver has a chance to intervene.
//We could have also modified velocities in the PositionFirstTimestepper's BeforeCollisionDetection callback, but it's just a little simpler to do this with very little cost.
Simulation = Simulation.Create(BufferPool, new TankCallbacks()
{
Properties = bodyProperties
}, new DemoPoseIntegratorCallbacks(new Vector3(0, -10, 0)), new PositionLastTimestepper());
var builder = new CompoundBuilder(BufferPool, Simulation.Shapes, 2);
builder.Add(new Box(1.85f, 0.7f, 4.73f), RigidPose.Identity, 10);
builder.Add(new Box(1.85f, 0.6f, 2.5f), new RigidPose(new Vector3(0, 0.65f, -0.35f)), 0.5f);
builder.BuildDynamicCompound(out var children, out var bodyInertia, out _);
builder.Dispose();
var bodyShape = new Compound(children);
var bodyShapeIndex = Simulation.Shapes.Add(bodyShape);
var wheelShape = new Cylinder(0.4f, .18f);
wheelShape.ComputeInertia(0.25f, out var wheelInertia);
var wheelShapeIndex = Simulation.Shapes.Add(wheelShape);
var projectileShape = new Sphere(0.1f);
projectileShape.ComputeInertia(0.2f, out var projectileInertia);
var tankDescription = new TankDescription
{
Body = TankPartDescription.Create(10, new Box(4f, 1, 5), RigidPose.Identity, 0.5f, Simulation.Shapes),
Turret = TankPartDescription.Create(1, new Box(1.5f, 0.7f, 2f), new RigidPose(new Vector3(0, 0.85f, 0.4f)), 0.5f, Simulation.Shapes),
Barrel = TankPartDescription.Create(0.5f, new Box(0.2f, 0.2f, 3f), new RigidPose(new Vector3(0, 0.85f, 0.4f - 1f - 1.5f)), 0.5f, Simulation.Shapes),
TurretAnchor = new Vector3(0f, 0.5f, 0.4f),
BarrelAnchor = new Vector3(0, 0.5f + 0.35f, 0.4f - 1f),
TurretBasis = Quaternion.Identity,
TurretServo = new ServoSettings(1f, 0f, 40f),
TurretSpring = new SpringSettings(10f, 1f),
BarrelServo = new ServoSettings(1f, 0f, 40f),
BarrelSpring = new SpringSettings(10f, 1f),
ProjectileShape = Simulation.Shapes.Add(projectileShape),
ProjectileSpeed = 100f,
BarrelLocalProjectileSpawn = new Vector3(0, 0, -1.5f),
ProjectileInertia = projectileInertia,
LeftTreadOffset = new Vector3(-1.9f, 0f, 0),
RightTreadOffset = new Vector3(1.9f, 0f, 0),
SuspensionLength = 1f,
SuspensionSettings = new SpringSettings(2.5f, 1.5f),
WheelShape = wheelShapeIndex,
WheelInertia = wheelInertia,
WheelFriction = 2f,
TreadSpacing = 1f,
WheelCountPerTread = 5,
WheelOrientation = QuaternionEx.CreateFromAxisAngle(Vector3.UnitZ, MathF.PI * -0.5f),
};
playerController = new TankController(Tank.Create(Simulation, bodyProperties, BufferPool, new RigidPose(new Vector3(0, 10, 0), Quaternion.Identity), tankDescription), 20, 5, 2, 1, 3.5f);
const int planeWidth = 257;
const float terrainScale = 3;
const float inverseTerrainScale = 1f / terrainScale;
var terrainPosition = new Vector2(1 - planeWidth, 1 - planeWidth) * terrainScale * 0.5f;
random = new Random(5);
//Add some building-ish landmarks.
var landmarkMin = new Vector3(planeWidth * terrainScale * -0.45f, 0, planeWidth * terrainScale * -0.45f);
var landmarkMax = new Vector3(planeWidth * terrainScale * 0.45f, 0, planeWidth * terrainScale * 0.45f);
var landmarkSpan = landmarkMax - landmarkMin;
for (int j = 0; j < 25; ++j)
{
var buildingShape = new Box(10 + (float)random.NextDouble() * 10, 20 + (float)random.NextDouble() * 20, 10 + (float)random.NextDouble() * 10);
var position = landmarkMin + landmarkSpan * new Vector3((float)random.NextDouble(), (float)random.NextDouble(), (float)random.NextDouble());
Simulation.Statics.Add(new StaticDescription(
new Vector3(0, buildingShape.HalfHeight - 4f + GetHeightForPosition(position.X, position.Z, planeWidth, inverseTerrainScale, terrainPosition), 0) + position,
QuaternionEx.CreateFromAxisAngle(Vector3.UnitY, (float)random.NextDouble() * MathF.PI),
new CollidableDescription(Simulation.Shapes.Add(buildingShape), 0.1f)));
}
DemoMeshHelper.CreateDeformedPlane(planeWidth, planeWidth,
(int vX, int vY) =>
{
var position2D = new Vector2(vX, vY) * terrainScale + terrainPosition;
return(new Vector3(position2D.X, GetHeightForPosition(position2D.X, position2D.Y, planeWidth, inverseTerrainScale, terrainPosition), position2D.Y));
}, new Vector3(1, 1, 1), BufferPool, out var planeMesh);
Simulation.Statics.Add(new StaticDescription(new Vector3(0, 0, 0),
new CollidableDescription(Simulation.Shapes.Add(planeMesh), 0.1f)));
explosions = new QuickList <Explosion>(32, BufferPool);
//Create the AI tanks.
const int aiTankCount = 100;
aiTanks = new QuickList <AITank>(aiTankCount, BufferPool);
playAreaMin = new Vector2(landmarkMin.X, landmarkMin.Z);
playAreaMax = new Vector2(landmarkMax.X, landmarkMax.Z);
var playAreaSpan = playAreaMax - playAreaMin;
for (int i = 0; i < aiTankCount; ++i)
{
var horizontalPosition = playAreaMin + new Vector2((float)random.NextDouble(), (float)random.NextDouble()) * playAreaSpan;
aiTanks.AllocateUnsafely() = new AITank
{
Controller = new TankController(
Tank.Create(Simulation, bodyProperties, BufferPool, new RigidPose(
new Vector3(horizontalPosition.X, 10, horizontalPosition.Y),
QuaternionEx.CreateFromAxisAngle(new Vector3(0, 1, 0), (float)random.NextDouble() * 0.1f)),
tankDescription), 20, 5, 2, 1, 3.5f),
HitPoints = 5
};
}
}
public override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(0, 5, 10);
camera.Yaw = 0;
camera.Pitch = 0;
var properties = new BodyProperty <CarBodyProperties>();
Simulation = Simulation.Create(BufferPool, new CarCallbacks()
{
Properties = properties
}, new DemoPoseIntegratorCallbacks(new Vector3(0, -10, 0)));
var builder = new CompoundBuilder(BufferPool, Simulation.Shapes, 2);
builder.Add(new Box(1.85f, 0.7f, 4.73f), RigidPose.Identity, 10);
builder.Add(new Box(1.85f, 0.6f, 2.5f), new RigidPose(new Vector3(0, 0.65f, -0.35f)), 0.5f);
builder.BuildDynamicCompound(out var children, out var bodyInertia, out _);
builder.Dispose();
var bodyShape = new Compound(children);
var bodyShapeIndex = Simulation.Shapes.Add(bodyShape);
var wheelShape = new Cylinder(0.4f, .18f);
wheelShape.ComputeInertia(0.25f, out var wheelInertia);
var wheelShapeIndex = Simulation.Shapes.Add(wheelShape);
const float x = 0.9f;
const float y = -0.1f;
const float frontZ = 1.7f;
const float backZ = -1.7f;
playerController = new SimpleCarController(SimpleCar.Create(Simulation, properties, new RigidPose(new Vector3(0, 10, 0), Quaternion.Identity), bodyShapeIndex, bodyInertia, 0.5f, wheelShapeIndex, wheelInertia, 2f,
new Vector3(-x, y, frontZ), new Vector3(x, y, frontZ), new Vector3(-x, y, backZ), new Vector3(x, y, backZ), new Vector3(0, -1, 0), 0.25f,
new SpringSettings(5f, 0.7f), Quaternion.CreateFromAxisAngle(Vector3.UnitZ, MathF.PI * 0.5f)),
forwardSpeed: 75, forwardForce: 6, zoomMultiplier: 2, backwardSpeed: 30, backwardForce: 4, idleForce: 0.25f, brakeForce: 7, steeringSpeed: 1.5f, maximumSteeringAngle: MathF.PI * 0.23f);
//Create a bunch of AI cars to race against.
const int aiCount = 384;
BufferPool.Take(aiCount, out aiControllers);
const int planeWidth = 257;
const float scale = 3;
Vector2 terrainPosition = new Vector2(1 - planeWidth, 1 - planeWidth) * scale * 0.5f;
raceTrack = new RaceTrack {
QuadrantRadius = (planeWidth - 32) * scale * 0.25f, Center = default
};
var random = new Random(5);
//Add some building-ish landmarks in the middle of each of the four racetrack quadrants.
for (int i = 0; i < 4; ++i)
{
var landmarkCenter = new Vector3((i & 1) * raceTrack.QuadrantRadius * 2 - raceTrack.QuadrantRadius, -20, (i & 2) * raceTrack.QuadrantRadius - raceTrack.QuadrantRadius);
var landmarkMin = landmarkCenter - new Vector3(raceTrack.QuadrantRadius * 0.5f, 0, raceTrack.QuadrantRadius * 0.5f);
var landmarkSpan = new Vector3(raceTrack.QuadrantRadius, 0, raceTrack.QuadrantRadius);
for (int j = 0; j < 25; ++j)
{
var buildingShape = new Box(10 + (float)random.NextDouble() * 10, 20 + (float)random.NextDouble() * 20, 10 + (float)random.NextDouble() * 10);
Simulation.Statics.Add(new StaticDescription(
new Vector3(0, buildingShape.HalfHeight, 0) + landmarkMin + landmarkSpan * new Vector3((float)random.NextDouble(), (float)random.NextDouble(), (float)random.NextDouble()),
Quaternion.CreateFromAxisAngle(Vector3.UnitY, (float)random.NextDouble() * MathF.PI),
new CollidableDescription(Simulation.Shapes.Add(buildingShape), 0.1f)));
}
}
Vector3 min = new Vector3(-planeWidth * scale * 0.45f, 10, -planeWidth * scale * 0.45f);
Vector3 span = new Vector3(planeWidth * scale * 0.9f, 15, planeWidth * scale * 0.9f);
for (int i = 0; i < aiCount; ++i)
{
//The AI cars are very similar, except... we handicap them a little to make the player good about themselves.
var position = min + span * new Vector3((float)random.NextDouble(), (float)random.NextDouble(), (float)random.NextDouble());
var orientation = Quaternion.CreateFromAxisAngle(new Vector3(0, 1, 0), (float)random.NextDouble() * MathF.PI * 2);
aiControllers[i].Controller = new SimpleCarController(SimpleCar.Create(Simulation, properties, new RigidPose(position, orientation), bodyShapeIndex, bodyInertia, 0.5f, wheelShapeIndex, wheelInertia, 2f,
new Vector3(-x, y, frontZ), new Vector3(x, y, frontZ), new Vector3(-x, y, backZ), new Vector3(x, y, backZ), new Vector3(0, -1, 0), 0.25f,
new SpringSettings(5, 0.7f), Quaternion.CreateFromAxisAngle(Vector3.UnitZ, MathF.PI * 0.5f)),
forwardSpeed: 50, forwardForce: 5, zoomMultiplier: 2, backwardSpeed: 10, backwardForce: 4, idleForce: 0.25f, brakeForce: 7, steeringSpeed: 1.5f, maximumSteeringAngle: MathF.PI * 0.23f);
aiControllers[i].LaneOffset = (float)random.NextDouble() * 20 - 10;
}
DemoMeshHelper.CreateDeformedPlane(planeWidth, planeWidth,
(int vX, int vY) =>
{
var octave0 = (MathF.Sin((vX + 5f) * 0.05f) + MathF.Sin((vY + 11) * 0.05f)) * 1.8f;
var octave1 = (MathF.Sin((vX + 17) * 0.15f) + MathF.Sin((vY + 19) * 0.15f)) * 0.9f;
var octave2 = (MathF.Sin((vX + 37) * 0.35f) + MathF.Sin((vY + 93) * 0.35f)) * 0.4f;
var octave3 = (MathF.Sin((vX + 53) * 0.65f) + MathF.Sin((vY + 47) * 0.65f)) * 0.2f;
var octave4 = (MathF.Sin((vX + 67) * 1.50f) + MathF.Sin((vY + 13) * 1.5f)) * 0.125f;
var distanceToEdge = planeWidth / 2 - Math.Max(Math.Abs(vX - planeWidth / 2), Math.Abs(vY - planeWidth / 2));
var edgeRamp = 25f / (distanceToEdge + 1);
var terrainHeight = octave0 + octave1 + octave2 + octave3 + octave4;
var vertexPosition = new Vector2(vX * scale, vY * scale) + terrainPosition;
var distanceToTrack = raceTrack.GetDistance(vertexPosition);
var trackWeight = MathF.Min(1f, 3f / (distanceToTrack * 0.1f + 1f));
var height = trackWeight * -10f + terrainHeight * (1 - trackWeight);
return(new Vector3(vertexPosition.X, height + edgeRamp, vertexPosition.Y));
}, new Vector3(1, 1, 1), BufferPool, out var planeMesh);
Simulation.Statics.Add(new StaticDescription(new Vector3(0, -15, 0), Quaternion.CreateFromAxisAngle(new Vector3(0, 1, 0), MathF.PI / 2),
new CollidableDescription(Simulation.Shapes.Add(planeMesh), 0.1f)));
}
public unsafe override void Initialize(ContentArchive content, Camera camera)
{
camera.Position = new Vector3(-13f, 6, -13f);
camera.Yaw = MathHelper.Pi * 3f / 4;
camera.Pitch = MathHelper.Pi * 0.05f;
Simulation = Simulation.Create(BufferPool, new TestCallbacks());
Simulation.PoseIntegrator.Gravity = new Vector3(0, -10, 0);
using (var compoundBuilder = new CompoundBuilder(BufferPool, Simulation.Shapes, 8))
{
{
//Note that, in bepuphysics v2, there is no 'recentering' when constructing a shape. The pose you pass in for a child is exactly the pose that the compound will use,
//even if the 'true' center of mass isn't at the local origin.
//Instead, if recentering is desired, it should performed ahead of time. The CompoundBuilder can help with this.
//We'll construct this compound using shapes far from the origin, and then use the CompoundBuilder overload that recenters the children and outputs the computed center.
var capsuleChildShape = new Capsule(0.5f, 0.5f);
var capsuleLocalPose = new RigidPose {
Position = new Vector3(-0.5f, 4, 4), Orientation = BepuUtilities.Quaternion.Identity
};
var boxChildShape = new Box(0.5f, 1f, 1.5f);
var boxLocalPose = new RigidPose {
Position = new Vector3(0.5f, 4, 4), Orientation = BepuUtilities.Quaternion.Identity
};
//All allocations from the buffer pool used for the final compound shape will be disposed when the demo is disposed. Don't have to worry about leaks in these demos.
compoundBuilder.Add(capsuleChildShape, capsuleLocalPose, 1);
compoundBuilder.Add(boxChildShape, boxLocalPose, 1);
compoundBuilder.BuildDynamicCompound(out var compoundChildren, out var compoundInertia, out var compoundCenter);
compoundBuilder.Reset();
var compound = new Compound(compoundChildren);
var compoundDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(compound),
SpeculativeMargin = 0.1f,
},
LocalInertia = compoundInertia,
Pose = new RigidPose {
Position = compoundCenter, Orientation = BepuUtilities.Quaternion.Identity
},
};
Simulation.Bodies.Add(compoundDescription);
}
//Build a stack of sphere grids to stress manifold reduction heuristics in a convex-ish situation.
{
var gridShape = new Sphere(0.5f);
const float gridSpacing = 1.5f;
const int gridWidth = 3;
var gridShapeIndex = Simulation.Shapes.Add(gridShape);
gridShape.ComputeInertia(1, out var gridBoxInertia);
float localPoseOffset = -0.5f * gridSpacing * (gridWidth - 1);
for (int i = 0; i < gridWidth; ++i)
{
for (int j = 0; j < gridWidth; ++j)
{
var localPose = new RigidPose
{
Orientation = BepuUtilities.Quaternion.Identity,
Position = new Vector3(localPoseOffset, 0, localPoseOffset) + new Vector3(gridSpacing) * new Vector3(i, 0, j)
};
compoundBuilder.Add(gridShapeIndex, localPose, gridBoxInertia.InverseInertiaTensor, 1);
}
}
compoundBuilder.BuildDynamicCompound(out var gridChildren, out var gridInertia, out var center);
compoundBuilder.Reset();
var gridCompound = new Compound(gridChildren);
var bodyDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(gridCompound),
SpeculativeMargin = 0.1f,
},
LocalInertia = gridInertia,
Pose = new RigidPose {
Orientation = BepuUtilities.Quaternion.Identity
}
};
for (int i = 0; i < 4; ++i)
{
bodyDescription.Pose.Position = new Vector3(0, 2 + i * 3, 0);
//if (i == 0)
// gridDescription.LocalInertia = new BodyInertia();
//else
// gridDescription.LocalInertia = gridInertia;
Simulation.Bodies.Add(bodyDescription);
}
}
//Build a table and use it for a couple of different tests.
{
var legShape = new Box(0.2f, 1, 0.2f);
legShape.ComputeInertia(1f, out var legInverseInertia);
var legShapeIndex = Simulation.Shapes.Add(legShape);
var legPose0 = new RigidPose {
Position = new Vector3(-1.5f, 0, -1.5f), Orientation = BepuUtilities.Quaternion.Identity
};
var legPose1 = new RigidPose {
Position = new Vector3(-1.5f, 0, 1.5f), Orientation = BepuUtilities.Quaternion.Identity
};
var legPose2 = new RigidPose {
Position = new Vector3(1.5f, 0, -1.5f), Orientation = BepuUtilities.Quaternion.Identity
};
var legPose3 = new RigidPose {
Position = new Vector3(1.5f, 0, 1.5f), Orientation = BepuUtilities.Quaternion.Identity
};
compoundBuilder.Add(legShapeIndex, legPose0, legInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(legShapeIndex, legPose1, legInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(legShapeIndex, legPose2, legInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(legShapeIndex, legPose3, legInverseInertia.InverseInertiaTensor, 1);
var tableTopPose = new RigidPose {
Position = new Vector3(0, 0.6f, 0), Orientation = BepuUtilities.Quaternion.Identity
};
var tableTopShape = new Box(3.2f, 0.2f, 3.2f);
compoundBuilder.Add(tableTopShape, tableTopPose, 3);
compoundBuilder.BuildDynamicCompound(out var tableChildren, out var tableInertia, out var tableCenter);
compoundBuilder.Reset();
var table = new Compound(tableChildren);
var tableDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(table),
SpeculativeMargin = 0.1f,
},
LocalInertia = tableInertia,
Pose = new RigidPose {
Orientation = BepuUtilities.Quaternion.Identity
}
};
//Stack some tables.
{
for (int i = 0; i < 10; ++i)
{
tableDescription.Pose.Position = new Vector3(10, 3 + i * 1.4f, 10);
Simulation.Bodies.Add(tableDescription);
}
}
//Put a table on top of a sphere to stress out nonconvex reduction for divergent normals.
{
tableDescription.Pose.Position = new Vector3(10, 6, 0);
Simulation.Bodies.Add(tableDescription);
var sphereShape = new Sphere(3);
var sphereIndex = Simulation.Shapes.Add(sphereShape);
var sphereDescription = new StaticDescription
{
Collidable = new CollidableDescription
{
Shape = sphereIndex,
SpeculativeMargin = 0.1f,
},
Pose = new RigidPose {
Position = new Vector3(10, 2, 0), Orientation = BepuUtilities.Quaternion.Identity
}
};
Simulation.Statics.Add(sphereDescription);
}
//Put another table on the ground, but with a clamp-ish thing on it that generates opposing normals.
{
tableDescription.Pose.Position = new Vector3(10, 3, -10);
Simulation.Bodies.Add(tableDescription);
var clampPieceShape = new Box(2f, 0.1f, 0.3f);
clampPieceShape.ComputeInertia(1f, out var clampPieceInverseInertia);
var clampPieceShapeIndex = Simulation.Shapes.Add(clampPieceShape);
var clamp0 = new RigidPose {
Position = new Vector3(0, -0.2f, -1.1f), Orientation = BepuUtilities.Quaternion.Identity
};
var clamp1 = new RigidPose {
Position = new Vector3(0, 0.2f, -1.1f), Orientation = BepuUtilities.Quaternion.Identity
};
var clamp2 = new RigidPose {
Position = new Vector3(0, -0.2f, 0), Orientation = BepuUtilities.Quaternion.Identity
};
var clamp3 = new RigidPose {
Position = new Vector3(0, 0.2f, 0), Orientation = BepuUtilities.Quaternion.Identity
};
var clamp4 = new RigidPose {
Position = new Vector3(0, -0.2f, 1.1f), Orientation = BepuUtilities.Quaternion.Identity
};
var clamp5 = new RigidPose {
Position = new Vector3(0, 0.2f, 1.1f), Orientation = BepuUtilities.Quaternion.Identity
};
compoundBuilder.Add(clampPieceShapeIndex, clamp0, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp1, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp2, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp3, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp4, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.Add(clampPieceShapeIndex, clamp5, clampPieceInverseInertia.InverseInertiaTensor, 1);
compoundBuilder.BuildDynamicCompound(out var clampChildren, out var clampInertia, out var clampCenter);
compoundBuilder.Reset();
var clamp = new Compound(clampChildren);
var clampDescription = new BodyDescription
{
Activity = new BodyActivityDescription {
SleepThreshold = 0.01f, MinimumTimestepCountUnderThreshold = 32
},
Collidable = new CollidableDescription
{
Shape = Simulation.Shapes.Add(clamp),
SpeculativeMargin = 0.1f,
},
LocalInertia = clampInertia,
Pose = new RigidPose {
Position = tableDescription.Pose.Position + new Vector3(2f, 0.3f, 0), Orientation = BepuUtilities.Quaternion.Identity
}
};
Simulation.Bodies.Add(clampDescription);
}
}
}
//Prevent stuff from falling into the infinite void.
{
var boxShape = new Box(100, 1, 100);
var groundShapeIndex = Simulation.Shapes.Add(boxShape);
var groundDescription = new StaticDescription
{
Collidable = new CollidableDescription
{
Shape = groundShapeIndex,
SpeculativeMargin = 0.1f,
},
Pose = new RigidPose {
Position = new Vector3(0, 0, 0), Orientation = BepuUtilities.Quaternion.Identity
}
};
Simulation.Statics.Add(groundDescription);
}
}
internal CompoundWordProperties(CompoundBuilder cwb) : base(cwb)
{
Model = cwb;
}
