public DynamicState(DynamicState state)
{
this.position = state.position;
this.angle = state.angle;
this.velocity = state.velocity;
this.force = state.force;
this.angularVelocity = state.angularVelocity;
this.torque = state.torque;
}
public void saveBeforeStepState()
{
this.beforeStepState = new DynamicState(currentState);
}
public void saveBeforeIterationState()
{
this.beforeIterationState = new DynamicState(currentState);
}
