Libraries

Dave`s not here today so I thought it would be a good day to start organizing our code. Right now it`s a huge mess. It wasn`t even devided into functions and most of the variables and code was canibalized for other applications so half the original code didn`t even work. I spent the day putting everything into legible and usable functions with relivant variable names and then putting them into header files.