Fixed Issue 7

Issue 7: Pulled functions out into a header and cpp files to make a library. Functionality should not have been changed at all. The .ino only contains setup and loop which use the functions included in the library.