FYES RK4 works for collision and damping