First Commit

First functional test!
Just a few problems with the frequency accuracy.