Add lib directory
Rearrange code a bit to move towards having loop/setup in its own file.
Move files from .ino -> .cpp