Working Sampling Rate Code

Revised sampling rate code and now timer2 stuff is working like it
should