public void BuildTest()
{
var jacobian = new AngularLimit2DJacobian();
var aFromConstraint = MTransform.Identity;
var bFromConstraint = MTransform.Identity;
var velocityA = MotionVelocity.Zero;
var velocityB = MotionVelocity.Zero;
var motionA = MotionData.Zero;
var motionB = MotionData.Zero;
var constraint = new Constraint()
{
ConstrainedAxes = new bool3(true, true, false)
};
var tau = 1.0f;
var damping = 1.0f;
jacobian.Build(aFromConstraint, bFromConstraint, velocityA, velocityB, motionA, motionB, constraint, tau, damping);
Assert.AreEqual(new float3(0.0f, 0.0f, 1.0f), jacobian.AxisAinA);
Assert.AreEqual(new float3(0.0f, 0.0f, 1.0f), jacobian.AxisBinB);
Assert.AreEqual(0.0f, jacobian.MinAngle);
Assert.AreEqual(0.0f, jacobian.MaxAngle);
Assert.AreEqual(1.0f, jacobian.Tau);
Assert.AreEqual(1.0f, jacobian.Damping);
Assert.AreEqual(quaternion.identity, jacobian.BFromA);
Assert.AreEqual(0.0f, jacobian.InitialError);
}
public void SolveTest()
{
var jacobian = new AngularLimit2DJacobian()
{
BFromA = quaternion.identity
};
var velocityA = MotionVelocity.Zero;
var velocityB = MotionVelocity.Zero;
var timestep = 1.0f;
jacobian.Solve(ref velocityA, ref velocityB, timestep);
Assert.AreEqual(MotionVelocity.Zero, velocityA);
Assert.AreEqual(MotionVelocity.Zero, velocityB);
}
