public void LinearBasicStepTest()
{
World w = new World ();
Rigid r = new Rigid (10, new Matrix (1, 1, 1));
w.AddRigid (r);
w.AddEffect (new Force (new Vector (1, 0, 0), r));
State s = new State (w, 0.001);
s.InitState ();
s.ForwardStep ();
Assert.AreEqual (10, s.RigidStates [r].Mass, 0.0001);
Assert.AreEqual (1, s.RigidStates [r].StateForceList.Force.X, 0.001);
Assert.AreEqual (0.1, s.RigidStates [r].LinearAcceleration.X, 0.001);
}
public void OneWorldTwoStatesTest()
{
World w = new World ();
Rigid r1 = new Rigid (30, new Matrix (70, 70, 70));
w.AddRigid (r1);
w.AddEffect (new Force (new Vector (30, 0, 0), r1, new Vector (5, 0, 0)));
w.AddEffect (new Moment (new Vector (0, 0, 50), r1));
Rigid r2 = new Rigid (5, new Matrix (200, 200, 200));
r2.StartCenterOfMass = new Vector (10, 10, 10);
w.AddRigid (r2);
w.AddEffect (new Force (new Vector (10, 0, 0), r2, new Vector (0, -100, 0)));
State s1 = new State (w, 0.0001);
State s2 = new State (w, 0.001);
s1.Simulate (1);
s2.Simulate (2);
s1.ForwardStep ();
Assert.AreEqual (0, s1.RigidStates [r1].LinearAcceleration.Y, 0.1);
Assert.AreEqual (0, s1.RigidStates [r1].LinearVelocity.Y, 0.1);
Assert.AreEqual (0, s1.RigidStates [r1].CenterOfMass.Y, 0.1);
Assert.AreEqual (1, s1.RigidStates [r1].LinearAcceleration.X, 0.1);
Assert.AreEqual (1, s1.RigidStates [r1].LinearVelocity.X, 0.1);
Assert.AreEqual (0.5, s1.RigidStates [r1].CenterOfMass.X, 0.1);
Assert.AreEqual (0.71, s1.RigidStates [r1].AngularAcceleration.Z, 0.1);
Assert.AreEqual (0.71, s1.RigidStates [r1].AngularVelocity.Z, 0.1);
Assert.AreEqual (0.36, s1.RigidStates [r1].AnglesOfRotation.Z, 0.1);
Assert.AreEqual (0, s1.RigidStates [r2].LinearAcceleration.Y, 0.1);
Assert.AreEqual (0, s1.RigidStates [r2].LinearVelocity.Y, 0.1);
Assert.AreEqual (10, s1.RigidStates [r2].CenterOfMass.Y, 0.1);
Assert.AreEqual (2, s1.RigidStates [r2].LinearAcceleration.X, 0.1);
Assert.AreEqual (2, s1.RigidStates [r2].LinearVelocity.X, 0.1);
Assert.AreEqual (11, s1.RigidStates [r2].CenterOfMass.X, 0.1);
Assert.AreEqual (10, s1.RigidStates [r2].CenterOfMass.Z, 0.1);
Assert.AreEqual (5, s1.RigidStates [r2].AngularAcceleration.Z, 0.1);
Assert.AreEqual (5, s1.RigidStates [r2].AngularVelocity.Z, 0.1);
Assert.AreEqual (2.5, s1.RigidStates [r2].AnglesOfRotation.Z, 0.1);
Assert.AreEqual (0, s2.RigidStates [r1].LinearAcceleration.Y, 0.1);
Assert.AreEqual (0, s2.RigidStates [r1].LinearVelocity.Y, 0.1);
Assert.AreEqual (0, s2.RigidStates [r1].CenterOfMass.Y, 0.1);
Assert.AreEqual (1, s2.RigidStates [r1].LinearAcceleration.X, 0.1);
Assert.AreEqual (2, s2.RigidStates [r1].LinearVelocity.X, 0.1);
Assert.AreEqual (2, s2.RigidStates [r1].CenterOfMass.X, 0.1);
Assert.AreEqual (0.71, s2.RigidStates [r1].AngularAcceleration.Z, 0.1);
Assert.AreEqual (1.43, s2.RigidStates [r1].AngularVelocity.Z, 0.1);
Assert.AreEqual (1.43, s2.RigidStates [r1].AnglesOfRotation.Z, 0.1);
Assert.AreEqual (0, s2.RigidStates [r2].LinearAcceleration.Y, 0.1);
Assert.AreEqual (0, s2.RigidStates [r2].LinearVelocity.Y, 0.1);
Assert.AreEqual (10, s2.RigidStates [r2].CenterOfMass.Y, 0.1);
Assert.AreEqual (2, s2.RigidStates [r2].LinearAcceleration.X, 0.1);
Assert.AreEqual (4, s2.RigidStates [r2].LinearVelocity.X, 0.1);
Assert.AreEqual (14, s2.RigidStates [r2].CenterOfMass.X, 0.1);
Assert.AreEqual (10, s2.RigidStates [r2].CenterOfMass.Z, 0.1);
Assert.AreEqual (5, s2.RigidStates [r2].AngularAcceleration.Z, 0.1);
Assert.AreEqual (10, s2.RigidStates [r2].AngularVelocity.Z, 0.1);
Assert.AreEqual (10, s2.RigidStates [r2].AnglesOfRotation.Z, 0.1);
}
