Simple Harmonic Motion Function PROVED