Added new files to lib to make the project more modular. Added some elementary tests to see the functions do what they are intented to do.