Added Unit Testing Seperated Main and Algorithms

Decided to use unit testing to determine if my algorithms were working
with < 1000 in the input queue