Simple Harmonic Motion Formula