private static void AddSurfaces(MarbleMachine surfaces, KinematicsEngine engine)
{
var surfaceForce = new SurfaceForce(engine);
foreach (var surface in surfaces.Surfaces)
{
surfaceForce.AddSurface(surface);
}
engine.AddForce(surfaceForce);
}
static private void AddParticleStructure(ParticleStructure ps, KinematicsEngine engine)
{
// Add projectiles
foreach (var projectile in ps.Projectiles)
{
engine.AddProjectile(projectile);
}
// Add connectors
foreach (var connector in ps.Connectors)
{
// Remember to connect it both ways
engine.AddForce(new FiniteElementConnectorForce(connector.Projectile1, connector.Projectile2, connector.SpringConstant, connector.UnstretchedLength));
engine.AddForce(new FiniteElementConnectorForce(connector.Projectile2, connector.Projectile1, connector.SpringConstant, connector.UnstretchedLength));
}
}
static internal void RunFiniteElement()
{
var engine = new KinematicsEngine();
engine.AddForce(new ConstantGravitationForce(engine, new Vector(0, 0, -9.8)));
engine.AddForce(new GroundForce(engine));
var ps = new YourParticleStructure();
AddParticleStructure(ps, engine);
var adapter = new EngineAdapter(engine);
Sphere3D.NSegments = 40;
var visualization = new KinematicsVisualization(adapter);
visualization.Ground = true;
visualization.ConnectorRadiusScale = .1;
ProjectileAdapter.VisualSize = .1;
AddConnectorsToVisualizer(ps, visualization);
Timeline.MaximumPoints = 3000;
var fullViz = new MotionVisualizer(visualization);
//fullViz.BackgroundFile = "stars.jpg";
//fullViz.Add3DGraph("Position", () => engine.Time, () => ConvertToVector3D(engine.Projectiles[0].Position), "Time (s)", "Position (m)");
//fullViz.Add3DGraph("Velocity", () => engine.Time, () => ConvertToVector3D(engine.Projectiles[0].Velocity), "Time (s)", "Velocity (m/s)");
//fullViz.Add3DGraph("Acceleration", () => engine.Time, () => ConvertToVector3D(engine.Projectiles[0].Acceleration), "Time (s)", "Acceleration (m/s^2)");
//fullViz.Add3DGraph("Center of Mass", () => engine.Time, () => ConvertToVector3D(ps.CalcCOM()), "Time (s)", "Center of Mass (m)");
//fullViz.Add3DGraph("Rotation", () => ps.ProjectileList[0].Position.Polar, () => ConvertToVector3D(ps.ProjectileList[0].Position), "Y Position (m)", "Position");
//fullViz.AddSingleGraph("Rotation Motion", Colors.Teal, () => ps.ProjectileList[0].Position.Y, (() => ps.ProjectileList[0].Position.Z)
// , "Y Position", "Z Position");
fullViz.Show();
}
static internal void RunMarbleMadness()
{
var engine = new KinematicsEngine();
engine.AddForce(new ConstantGravitationForce(engine, new Vector(0, 0, -9.8)));
var ps = new YourParticleStructure();
var surfaces = new JayDongMarbleMachine();
AddParticleStructure(ps, engine);
AddSurfaces(surfaces, engine);
var adapter = new EngineAdapter(engine);
Sphere3D.NSegments = 40;
var visualization = new KinematicsVisualization(adapter);
visualization.Box = true;
visualization.ConnectorRadiusScale = .1;
ProjectileAdapter.VisualSize = .01;
AddConnectorsToVisualizer(ps, visualization);
AddSurfacesToVisualizer(surfaces, visualization);
Timeline.MaximumPoints = 3000;
var fullViz = new MotionVisualizer(visualization);
//fullViz.BackgroundFile = "stars.jpg";
fullViz.Add3DGraph("Position", () => engine.Time, () => ConvertToVector3D(engine.Projectiles[0].Position), "Time (s)", "Position (m)");
fullViz.Add3DGraph("Velocity", () => engine.Time, () => ConvertToVector3D(engine.Projectiles[0].Velocity), "Time (s)", "Velocity (m/s)");
fullViz.Add3DGraph("Acceleration", () => engine.Time, () => ConvertToVector3D(engine.Projectiles[0].Acceleration), "Time (s)", "Acceleration (m/s^2)");
//fullViz.AddSingleGraph("Speed", Colors.Teal, () => engine.Time, (() => engine.Projectiles[0].Velocity.Magnitude),
// "Time (s)", "Speed (m/s)");
fullViz.Show();
}
public GroundForce(KinematicsEngine engine) :
base(engine)
{
this.engine = engine;
}
public SurfaceForce(KinematicsEngine engine) :
base(engine)
{
this.engine = engine;
}
public EngineAdapter(KinematicsEngine engine)
{
this.engine = engine;
}
