SecondOrderDynamics constructor

SecondOrderDynamics(
  1. double f,
  2. double z,
  3. double r,
  4. Vector2 initial,
)

Implementation

SecondOrderDynamics(
  double f,
  double z,
  double r,
  Vector2 initial,
)   : posPrev = initial.clone(),
      pos = initial.clone(),
      vel = Vector2.zero() {
  k1 = z / (pi * f);
  final double twopif = 2 * pi * f;
  k2 = 1 / (twopif * twopif);
  k3 = r * z / twopif;
}