Simple harmonic motion equations