AngleLockEquation Class
Locks the relative angle between two bodies. The constraint tries to keep the dot product between two vectors, local in each body, to zero. The local angle in body i is a parameter.
Constructor
Item Index
Methods
Methods
addToWlambda
-
deltalambda
Add constraint velocity to the bodies.
Parameters:
-
deltalambdaNumber
computeB
()
Number
Computes the RHS of the SPOOK equation
Returns:
computeGiMf
()
Number
Computes G*inv(M)*f, where M is the mass matrix with diagonal blocks for each body, and f are the forces on the bodies.
Returns:
computeGiMGt
()
Number
Computes G*inv(M)*G'
Returns:
computeGq
()
Number
Computes G*q, where q are the generalized body coordinates
Returns:
computeGW
()
Number
Computes G*W, where W are the body velocities
Returns:
computeGWlambda
()
Number
Computes G*Wlambda, where W are the body velocities
Returns:
computeInvC
-
eps
Compute the denominator part of the SPOOK equation: C = G*inv(M)*G' + eps
Parameters:
-
epsNumber
Returns:
gmult
()
Number
Multiply a jacobian entry with corresponding positions or velocities
Returns:
setMaxTorque
-
torque
Set the max force for the equation.
Parameters:
-
torqueNumber
setRatio
-
ratio
Set the gear ratio for this equation
Parameters:
-
ratioNumber
update
()
Compute SPOOK parameters .a, .b and .epsilon according to the current parameters. See equations 9, 10 and 11 in the SPOOK notes.
Properties
enabled
Boolean
Whether this equation is enabled or not. If true, it will be added to the solver.
G
Array
The Jacobian entry of this equation. 6 numbers, 3 per body (x,y,angle).
maxForce
Number
Max force to apply when solving.
minForce
Number
Minimum force to apply when solving.
multiplier
Number
The resulting constraint multiplier from the last solve. This is mostly equivalent to the force produced by the constraint.
needsUpdate
Boolean
Indicates if stiffness or relaxation was changed.
ratio
Number
private
The gear ratio.
relativeVelocity
Number
Relative velocity.
relaxation
Number
The number of time steps needed to stabilize the constraint equation. Typically between 3 and 5 time steps.
stiffness
Number
The stiffness of this equation. Typically chosen to a large number (~1e7), but can be chosen somewhat freely to get a stable simulation.